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ABSTRACT 


Doppler  radar,  compass  heading,  and  VLF  communications  station 
phase  difference  information  are  combined  in  an  optimal  fashion  to  form  an 
integrated  navigation  system  based  on  the  concepts  of  Kalman  filtering.  A 
ten-state  Doppler/VLF  Kalman  filter  navigation  algorithm  is  designed  for  use 
onboard  the  NAE  Convair  580  aeromagnetics  research  aircraft,  with  simula¬ 
tion  studies  conducted  using  computer  programs  written  in  FORTRAN  for 
the  IBM  3032  TSS  operating  environment.  Results  from  the  studies  show  the 
unique  features  of  a  Kalman  filtering  approach  to  the  navigation  task. 
Various  contingencies,  or  anomalous  situations,  that  can  arise  when  handling 
the  VLF  data  are  considered,  and  solutions  are  offered  in  the  context  of  the 
Kalman  filter  approach  being  used.  A  comparison  study  involving  simulated 
navigation  data  demonstrates  the  superiority  of  the  Kalman  filter  navigator 
compared  to  simpler  navigation  algorithms,  especially  when  significant  bias 
errors  occur  in  the  basic  quantities  being  measured.  A  further  comparison 
study  based  on  navigation  data  collected  onboard  the  Convair  verifies  that 
the  proposed  Kalman  filter  navigation  algorithm  operates  properly  when 
using  typical  ‘real  world’  data. 


SOMMAIRE 


Des  donnees  de  radar  Doppler,  de  cap  au  cornpas  et  de  dephasage 
entre  stations  de  telecommunications  VLF  sont  eombinees  de  fayon  opti- 
male  dans  un  nouveau  systeme  de  navigation  integre  fonde  sur  les  principes 
du  filtrage  Kalman.  On  a  en  effet  elabore  un  algorithme  de  navigation  pour 
filtre  Kalman  Doppler/VLF  a  dix  etats  utilise  a  bord  de  Paeronef  de  recher¬ 
che  aeromagnetique  NAE  Convair  580;  des  etudes  de  simulation  ont  etc 
menees  a  l’aide  de  programmes  informatiques  rediges  en  FORTRAN  pour  le 
milieu  de  fonctionnement  du  systeme  TSS  IBM  3032.  Les  resultats  de  cos 
etudes  font  ressortir  l’apport  unique  du  filtrage  Kalman  dans  un  systeme  de 
navigation.  Diverses  contingencies  ou  anomalies  pouvant  se  presenter  lors  du 
traitement  des  donnees  VLF  sont  mises  en  evidence,  et  des  solutions  faisant 
appel  au  filtrage  Kalman  sont  proposer's,  line  etude  comparative  portant  sur 
des  donnees  de  navigation  simulees  demontre  la  suporiorito  du  liavigatour  a 
filtre  Kalman  par  rapport  ii  des  algorithmes  de  navigation  plus  simples,  sur- 
tout  lorsque  se  prescntent  des  orrours  non  centrees  import  antes  dans  les 
grandeurs  de  base  mesurees.  line  autre  etude  comparative  roposant  sur  des 
donnees  de  navigation  reeueillies  a  bord  du  Convair  continue  I'effieacite  de 
l’algorithme  de  navigation  pour  filtre  Kalman  lorsque  des  donnees  typiques 
et  ‘reelles’  sont  utilisees. 
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A  KALMAN  FILTER  APPROACH  TO  NAVIGATION  ON  THE 
NAE  CONVAIR  580  AEROMAGNETICS  RESEARCH  AIRCRAFT 

1.0  INTRODUCTION 

The  NAE  Convair  580  research  aircraft  has  onboard  various  navigation  aids,  including 
Doppler  radar,  C'-12  compass  heading,  VLF  station  phase  difference  information,  LORAN-C,  OMEGA 
station  phase  difference  information,  a  Litton  LTN-51  inertial  navigator,  and  the  possibility  of  a  GPS 
(Global  Positioning  System)  receiver  at  some  time  in  the  near  future  (Refs.  1  and  2).  With  so  much 
redundant  navigation  data  available,  it  is  important  to  try  to  use  it  as  effectively  as  possible.  A  Kalman 
filter  approach  (or  some  extension  of  it)  becomes  almost  esssential  in  such  a  situation  in  order  to 
‘blend’,  in  some  optimal  fashion,  the  various  types  of  navigation  information. 

At  the  Flight  Research  Laboratory,  a  study  was  initiated  in  May  1978  to  look  at  a  simple 
Doppler/VLF  navigation  filter  employing  the  Kalman  filter  technique.  The  purpose  of  this  study  was 
three-fold: 

i)  to  gain  an  understanding  of  basic  Kalman  filter  concepts  through  analyzing  a  relatively 
simple  version  of  a  Kalman  filter: 

li)  to  compare  the  Doppler/VLF  Kalman  filter  to  the  Doppler/VLF  complementary  filter 
being  used  at  present;  and 

iiil  to  demonstrate  the  possible  advantages  of  the  Kalman  filter  approach  for  other  applications 
at  Flight  Research  —  a  multi-sensor  hybrid  navigation  system  and  aircraft  attitude  sensing 
are  just  two  of  the  possibilities. 

2.0  THEORY  OF  KALMAN  FILTERING 

The  mathematical  theory  behind  the  concept  of  Kalman  filtering  involves  probability  and 
statistics  together  with  linear  systems  theory  in  a  state  vector  formulation.  In  this  chapter,  the  basic 
theory  will  bo  outlined  very  briefly  many  references  arc  available  for  a  more  complete  analysis  of 
the  theory  (e.g.  Ref.  8  is  an  excellent  textbook  on  the  subject  1. 

2.1  Elementary  Statistical  G’oncepts 

References  1  and  5  serve  as  a  very  good  source  for  gaining  a  quick  understanding  of  the 
underlying  principles  of  a  Kalman  filter.  In  its  very  simplest  form,  the  Kalman  filtering  process  con¬ 
sists  of  combining  two  independent  estimates  of  a  random  variable  to  form  a  weighted  average.  The 
optimal  weighting  factor  is  chosen  so  as  to  produce  a  weighted  average  having  the  minimum  variance. 
Let  xl  and  x2  be  two  independent  estimates  of  a  Gaussian  random  variable,  x.  having  variances 
I  -  and  nv  ,  -  respectively  ( see  Ref.  (i  for  basic  statistical  definitions).  Furthermore,  assume  that  x2 
is  estimated  by  measuring  y2  h  •  x2,  where  y2  has  the  variance  ov  ,  -  h-  •  i;N  ,  -  .  Now.  a  general 
form  for  the  weighted  average  of  xl  and  x2  would  be. 


x  l  1  K  •  h  l  *  \ 1  +  K  '  h  •  x2 


(  1  K  *  lit  •  xl  ♦  K  •  v2;  0  K  ’  h  -  1 


with  K  •  h  the ‘weighting’ on  x2  and  ( 1  K  ■  h  I  I  he ‘weight  mg' on  x  1  K  is  the  weighting  factor 


-  2  - 

From  Equation  (2.1),  the  statistical  expectation  (i.e.  mean  value)  of  x,  K(x),  can  be 
expressed  as. 


E(x)  =  (1  -  K  •  h)  •  E(xl)  +  K  •  H(y2)  1 12.2 1 

By  definition,  the  variance  of  x,  ax  - ,  would  be. 

as2  =  e{[x-  E(x)]-|  (2.3) 

The  following  expansion  of  Equation  (2.3)  can  then  be  developed: 

o\  -  =  E | [x  -  E(x)]-}  =  E)[(l  -  K  •  h)  •  xl 

+  K  •  y2-  (I  -  K  •  h)  •  E(xl )  -  K  •  E(y2)]:} 

=  E  |  [( 1  -  K  •  h )  •  ( xl  E(  xl »)  +  K  •  ( y2  -  E(y2) )] :  | 


=  e{(  1  -  K  •  hr’  •  [xl  -  E(xl )]  “  +  K:  •  [ 

y2-  E( y 2 1]  ■ 

2  •  K  •  ( 1  -  K  •  hi  •  [xl  Etxl)]  •  [y 

2  E(  y  2 )]  ) 

=  (1  -  K  •  h):  •  E  |  [x  1  -  E( xl )]  ’  J  +  K:  • 

e|[v2  -  Ety2) 

+  2  •  K  •  (1  -  K  •  h!  •  E([xl  E( x  1 )]  • 

[y2  -  Ety2i] } 

Now.  Ej|xl  E( x  1 ) |  *  | y 2  E( y 2 ) | }  “  0  because  xl  and  y 2  “  h  •  x2  are  assumed  to  be  independ¬ 
ent  estimates:  hence,  |xl  -  E(xl )  |  and  |  y  2  -  E|y2l|  '  h  •  1x2  E(x2)  |  must  be  uncorrelated.  The 
expansion  of  r;x-  then  reduces  to 


ox  ■  'll  K  •  hr’  •  ux  ,  :  +  K:  •  ux  ,  :  l  2.f)i 

To  determine  the  minimum  variance.  dx  -  .  as  a  function  of  weight  inn  factor.  K .  simply  different  iate 
Equation  (2.5)  with  respect  to  K  and  set  the  result  to  zero.  Thus, 


ilo  - 
\ 

3K 


2  •  h  •  1 1  -  K  •  h  I  ux  j  -  +  2  •  K  •  o.  , 


( 2  id 


o 


which  yields  the  optimum  value  of  K,  K,  as 


3  - 


h  •  i  : 

K  = -  (2.7) 

yx  2  2  *•  h2  •  y  x  j  2 

From  Equation  (2.1 ),  the  expression  for  the  best  estimate,  x,  can  be  written  as, 

x  =  (1  -  K  •  h)  •  xl  +  K  •  h  •  x2  =  xl  K  ■  |h  •  xl  y2l  (2.8) 

and.  from  Equations  (2.5)  and  (2.7),  the  expression  for  the  variance  of  x,  oN  2 .  becomes, 

uv  2  -  1 1  K  •  h>2  •  ,  2  +  K2  •  o>  , 2 


h2  • 


-  '  <\  : ' 

li2  •  o.  ,  2  +  y. 


h  •  t\  ,  2 


h2  •  (»xl  2  +  <;x 


‘  o. 


(2.9) 


K  i 


(K 


h2  •  oN|  2  +  yx 


\  i  2  •  ( 1  K  •  h)  <>s  |  2  K  •  li 


If  one  assumes  that  v2  li  •  x2  is  a  measurement  used  to  improve  an  updated  estimate,  xl .  then 
Equations  ( 2.8)  and  ( 2.9)  indicate  just  how  the  estimate  and  its  variance  are  improved  by  the  measure 
ment. 

2.2  State  Variable  Formulation  for  a  Linear  Kalman  Filter 

In  order  to  apply  Kalman  filtering  technique  to  any  particular  physical  problem  involving 
a  dynamic  process,  the  equations  of  motion  of  the  proves-  must  be  expressed  in  a  state  variable  formu¬ 
lation.  with  any  random  noise  processes  included  as  well  the  underlying  statistical  theory  will  be 
that  of  a  Markov  process.  Furthermore,  sampled  data  versions  of  the  various  equations  will  be  used  in 
order  to  reflect  the  more  practical  situation  of  having  to  deal  with  measurement  data  m  digital  form. 
First,  a  scalar  I  i.e.  one-dimensional  l  Kalman  biter  will  be  developed  to  outline  the  basic  principles  of 
state  variable  formulations  and  Markov  processes:  then,  an  extension  to  the  general  multi  dimensional 
Kalman  filter  algorithm  will  take  place. 

2.2.1  Scalar  Kalman  Filter 

In  the  ensuing  mathematical  development  a  ‘system  state'  formulation  Is  assumed,  m  which 
the  actual  state  of  | lie  physical  system  is  to  be  estimated  using  a  Kalman  filter.  An  allernat ive  to  this 
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would  bo  tho  so-called  ‘error  state’  formulation,  in  which  it  is  only  the  error  in  the  particular  process 
state  which  is  to  he  estimated  via  a  Kalman  filter  (see  Ref.  5  for  an  interesting  example  of  an  error 
state  formulation). 

Assume  a  first-order  physical  system  exists  in  the  form  of  a  Markov  process  (see  Ref.  3  for 
definition),  as  follows: 

xk  +  i  =  fk  *  xk  +  Sk  ‘  uk  <2.iO| 

where 

xk  ^  true  state  of  the  process  at  time  tk 

fk  -  transition  term  representing  the  dynamics,  or  equation  of  motion, 

of  the  system 

uk  random  noise  input  with  zero  mean  and  variance  qk .  assumed  to  be 

Gaussian 

gk  scalar  multiplier  reflecting  the  effect  of  the  random  noise  process,  u. 

on  the  state  x 

Palliation  I  2.10|  is  known  as  the  plant  equation,  with  uk  the  so-called  plant  noise. 

As  well  as  a  scalar  plant  equation,  it  is  assumed  that  a  measurement  process  exists  in  which 
Uie  quantity  being  measured,  y.  is  some  linear  function  of  tne  state  of  the  system.  Thus, 

>Vi  =  hk  e  i  •  xk+,  +  vk)i  '2.111 

where 

yk  +  1  quantity  being  measured 

hk  +  |  scalar  multiplier  reflecting  the  relationship  between  the  measurement 

and  the  state 

vk ,  |  -  random  measurement  noise  with  zero  mean  and  variance  rk ,  (  . 

assumed  to  be  Gaussian 

Kquation  (2.11)  is  called  the  observation  (or  measurement)  equation,  with  vk  ,  ,  the  observation  (or 
measurement)  noise.  Note  that  f'k  ,  gk  ,  lik ,  qk .  and  rk  are  all  allowed  to  vary  from  one  sample  time  to 
the  next  in  this  formulation. 

In  order  to  relate  this  first-order  methematical  development  to  what  was  discovered  in 
Section  2.1  ( i.e.  about  optimally  combining  an  update  and  a  measurement ).  it  is  necessary  to  express 
the  variance  of  the  update.  pk  .  properly.  For  this  purpose,  define  the  following  quantities: 

xk  best  estimate  of  the  true  state  after  k  samples  of  data 

xk  t  !  state  update  based  on  xk  ,  i.e.  xk  ,  ,  =  fk  •  xk 
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Pk 

Pk*i 


variance  of  xk 

variance  of  the  update  xk  + 

random  error  in  xk ,  namely  xk  -  xk 

random  error  in  xk  + , ,  namely  xk  +  (  -  xk  +  f 


The  best  update  from  the  plant  equation  can  be  expressed  as, 

xk+ 1  =  fk  ’  K  =  fk  *  (xk +  ek> =  fk  ■  xk  +  fk '  ek 


Sc+.  -  §k  *Uk  +  fk  *Ck 


(2.12) 


Since  xk  +  ]  represents  the  true  value  of  x  at  tk  +  t ,  the  error  in  xk  +  ,  ,  ek  +  [ ,  must  be 


ek  +  l  -  xk+l  xk  + 1  ®k  ‘  Uk  +  ^k  "  Ck 


(2.13) 


Also,  the  variance  of  ek  +  , ,  var  j  ek  +  , }  ,  is  precisely  the  variance  of  xk  +  , ,  pk  +  , ,  because  xk  +  ,  =  E(  xk  +  ,  ) 
(i.e.  the  true  value  has  no  variance,  by  definition).  Therefore, 


Pk+,  =  var«+i  (  =  var{-gk  'uk  +  fk  -ek| 

=  var|-gk  -uk[  +  varjfk  *  ek  j 


(2.14) 


because  uk  and  ek  are  assumed  to  be  independent  random  processes.  With  var  {  uk  )  =  qk,  and 
var{ek)  =  var  {xk}  =  pk ,  Equation  (2.14)  becomes, 


Pk+1  =  f2k  '  Pk  +  g2k 

=  fk  ’  Pk  ’  fk  +  8k  ‘  ^k  '  &k 


(2.15) 


It  is  now  possible  to  make  comparisons  based  on  the  previous  developments  of  Section  2.1 .  At  step 
k+1  identify 


xl 

~~  xk  +  1  ’ 

axl 

+ 

-  -X 

a 

III 

=  fk  '  Pk  ’  fk  +  8k  ’  %  -  Sk 

y2 

-  Yk  1 1  ; 

°y  2 

-  rk  +  1  ’ 

h  s  hk  +  , 

(2.16) 

x 

=  xk  +  1  ’ 

A 

K  = 

Kk*. 

r 


- « - 

Equations  (2.7),  (2.8),  and  (2.9)  from  Section  2.1  can  then  lie  rewritten  as. 


K 


and 


= _ Pk  +  l  ‘ht*i 

hkH  *»\+1  ‘"t.l  +  rk. 


Km  •  (hk+!  *  XMI  -  >’k . .  ) 


Pk+i  =  !,k+i  -  Kk*i  *hk+i  ■  K*\ 


(2.17) 


(2.18) 


(2.191 


respectively.  Thus,  the  best  estimate  of  the  first-order  system  state,  xk  .  and  its  variance,  pk  ,  can  he 
updated  for  minimum  variance  at  each  step  by  sequencing,  recursively,  through  the  following  so-called 
Kalman  update  equations: 


xk+i  =  fk'xk 


k  +  I 


fk  '  i\  '  fk  +  ■  qk  *  xk 

Kk>i  =  iVm  '  hk  +  )  * [hk  +  i  '  Pk  +  i  •  hk*i  +  rk+ .] 
Sk*l  "  ’  (hk  +  I  ’  Xk  +  1  “  yk  +  l) 


-  I 


k  +  I 


plant  update 


variance  of  update 


Kalman  gain 


optimal  state  estimate 
after  k  +  1  samples 


(2.201 


l\+  I  Pk  H  Kk  +  I  *  (lk+  I  [>k  +  I 


variance  of  optimal 
state  estimate 


Note  that,  in  order  to  initiate  the  Kalman  recursion  formulas  of  Equation  (2.20),  it  is  necessary  to 
establish  initial  conditions  for  x  and  p  i.e.  x„  and  p(1.  These  initial  best  estimates  for  the  state  and 
its  variance  are  sometimes  difficult  to  determine  precisely  and.  so,  must  be  approximated  in  some 
manner  to  ‘start  off’  the  filter. 

2.2.2  General  Form  of  the  Linear  Kalman  Filter 

The  general  form  of  the  linear  Kalman  filter  for  the  multi  dimensional  situation  is  simply  an 
extension  of  the  foregoing  scalar  case  using  matrix  formulation.  A  general  nth-order  physical  process 
is  assumed  to  have  the  following  sampled  data  version  of  the  plant  equation: 


«|. 


k 


k 


k 


x 


k  ♦  I 


+  Gk  ‘  u 


(2.21  ) 


where 


x  k  nth-oreie*r  state  of  the  process  at  time  tk  ,  with  the  dimension  (n  x  1 ) 

'!>  .  (n  x  n)  transition  matrix  representing  the  known  dynamics  of  the  process 

u  k  ^  m^h-order  ( m  <  n  I  vevtor  representing  zero  mean,  random  disturbances,  or  plant 
noise,  in  the  system  —  dimension  (m  x  1 1 

(1  k  “  (n  x  ml  matrix  representing  the  effects  of  the  m  noise  sources  on  the  n  states  of  the 
system 


The  plant  noise  vector,  u  k ,  is  usually  assumed  to  correspond  to  a  set  of  m  zero  mean,  random  noise 
processes  with  constant  variances,  o’  :  1  =  1 . m;  all  noise  processes  are  assumed  to  be  independ¬ 

ent  of  each  other.  These  assumptions  of  Gaussian  noise-  result  in  an  (m  x  ml  covariance  matrix  for 
u  k ,  CJ  of  the  following  form: 


o:u|  0  •  •  •  0 

0  n 2  0  •  •  •  0 


=  9  s 


(2.221 


0 

0  0  •  •  0  o: 


In  conjunction  with  this  general  multi-dimensional  linear  plant,  assume  that  a  multi¬ 
dimensional  measurement  process  exists  as  follows: 


k  + 1 


H 


k  + 1 


ik  + 1 


+  v 


k  ♦  i 


(2,2.1 1 


where* 


yk  (  .  t’th-order  (V  -5  n)  set  of  measurements  at  time  t,  4  .  .  with  the  dimension  (V  x  1  | 


lk  f  |  (t  x  nl  matrix  which  e)pe*rate*s  on  x  k  ,  te>  repre*sent  the  relationship  between  state 

variable's  anel  me*asure*me*nts 


vk>|  (V  x  1 1  me*asure>ment  noise*  ve*etor  representing  ze*rei  mean,  ranelom  disturbances 


( i.e.  obse'rvatiem  noise!  in  e*ach  eif  the  measured  epiantitie*: 


The  measurement  noise  vector,  vk  + . ,  is  normally  assumed  to  be  a  set  of  V  zero  mean, 
random  noise  processes  having  constant  variances,  i  =  1,  .  .  .  ,  V  -  each  noise  process  is  also 

assumed  to  be  independent  of  the  others.  The  |  V  x  V)  covariance  matrix,  Rk,  (  ,  for  vk<  t  then 
becomes. 


o-\  ,  0 

0  o-\. 


Rk  +  ,  =  R 


0  o-vl 


( 2.21 1 


For  the  foregoing  multi-dimensional  process  and  measurement  configuration,  the  Kalman 
filter  task  is  to  compute  the  best  estimate  of  xk ,  xk ,  and  the  covariance  matrix  of  xk .  P  k .  at  each 

time  tk  ;  k  =  1 , 2 . As  in  the  scalar  case,  define  xk  t  ^  as  the  state  update  based  on  xk  ( i.e. 

xk  +  i  =  <J>  k  •  xR  );  and  define  P  k  + !  as  the  covariance  matrix  associated  with  \k  t ,  .  The  general 
form  for  the  Kalman  update  of  xk  and  P  k  (proof  given  in  Ref.  4)  is  then. 


*k+l  = 

*k 4 

plant  update 

pk+,  = 

i’k  • 

pk  4ll’k  +  2k 4 

2k 4 2t 

covariance  of  update 

II 

+ 

Jd 

£il 

p;+, 

*2kel  [U  k  +  1 

>PU)  4  2  k  +  ,  +  R  k  +  1 J 

i 

Kalman  gain  matrix 

*k  +  l  = 

^k+. 

-  2k+1  "  [{i  k  +  1 

-  yk+l] 

optimal  state  estimate 
after  k+1  samples 

pk+,  = 

p;+i 

Rk  +  I  "  2k  +  l 

•  p ' 
k  +  1 

covariance  of  optimal 
state  estimate 

(2.25) 


Note  the  strong  similarity  between  the  scalar  form  of  the  updates  given  in  Equation  (2.20),  and  the 
above  matrix  form.  The  matrix  recursion  formula  given  in  Equation  (2.25)  corresponds  to  a  mini¬ 
mization  of  P  k  +  (  at  each  step,  i.e.  the  optimal  state  estimate  is  always  the  one  having  minimum  error 
variance  in  the  Kalman  filter  approach  to  the  problem. 


Now  the  Kalman  filter  update  equations  define  a  set  of  recursion  relationships,  readily 
implemented  on  a  digital  computer,  for  computing  the  optimal  state  estimate  of  a  physical  process 
in  real  time  thus  is  the  essence  of  the  benefit  to  be  derived  from  a  Kalman  filter.  Assuming  that  the 


k 


w 
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plant  and  measurement  processes  arc  well-known  (i.c.  accurate  knowledge  of  <l>  k  ,  (1  k  .  Q  k  .  II  k  ,  and 

K  k  )  then  all  that  Is  required  to  net  the  Kalman  filter  stiirted  is  knowledge  of  the  initial  state  vector 

estimate,  \  ,  anil  its  initial,  or  so-called  a  priori,  covariance,  I*  .  Often  it  is  difficult  to  specify  an  accu- 

rate  estimate  of  1’  it  really  reflects  the  possible  variance  of  the  error  in  the  initial  state  estimate. 

The  covariance  matrix.  l’k.  is  quite  important  because  its  diagonal  elements  are  a  measure  of  the 

error  variance  of  the  individual  optimal  state  estimates  as  a  function  of  time.  Usually  the  estimation 
error  of  each  state  is  reduced  dramatically  during  the  first  part  of  a  Kalman  filter  run  and  then, 
eventually,  a  steady  state  error  condition  is  reached.  In  the  steady  state  region,  the  elements  of  both 
the  Kalman  gain  matrix,  K  k  ,  and  the  covariance  matrix,  P  k ,  become  small  and  near-constant. 


2.3  A  Quasi-I, inear  Approach  for  Nonlinear  Systems 

Many  practical  problems  for  which  a  Kalman  filter  approach  would  be  quite  useful  involve 
nonlinear  plant  equations  and/or  nonlinear  measurement  equations.  In  most  cases,  it  would  be  too 
inaccurate  to  linearize  the  equations  completely,  so  some  quasi-linear  approach  must  be  found. 
Kriedland  and  Bernstein  |  Kef.  7  I  and  Kichman  and  Kriedland  ( ltef.  K)  have  suggested  one  approximate 
quasi-linear  technique  which  will  be  outlined  here;  there  are  also  other  possible  i  xteiisioii-  of  tin 
Kalman  filter  to  include  nonlinearities  (see  Ref.  ■'!.  Ch.  S). 

Maintaining  the  same  notation  as  m  Subsection  2.2.2.  define  a  nonlinear  sampled  data 
plant  equation. 


xk-i  _  f,xk>  +  (;k  •  uk 


so  that,  in  general,  an  In  x  1 )  vector,  f  ,  with  elements  consisting  of  nonlinear  functions  of  the  state, 
x  .  replaces  the  linear  vector  function,  <l>  k  •  x  k .  of  Kquation  I  2.21  I.  In  similar  fashion,  a  nonlinear 
observation  equation. 


>'k.i  h<xk.|  »  +  vk.| 


is  assumed,  where  the  |  f  x  1  I  vector,  h .  has  elements  consist  mg  of  nonlinear  functions  of  x :  and  h 

replaces  II  •  x  k  (  |  of  Kquation  I  2.231.  The  noise  process  vectors.  uk  and  vk  .  are  assumed  to  have 
the  same  general  statistics  as  those  defined  ill  Subsection  2.2.2. 

Consider  now  a  quasi  linear  state  transition  matrix,  'I'  ,  whose  elements  arc  defined  as. 


di  ll  X  1 


.  i  1 .....  ii ;  j  1 . n 


2M 
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and  a  quasi-linear  observation  matrix,  1 1  k ,  having  the  elements. 


<)hi(x) 

hxj 


:  i  =  1,  .  .  .  ,  t:  j  =  1 , .  .  .  ,  n 


(2.29) 


The  Kalman  filter  update  equations  for  the  quasi-linear  best  estimate,  xk  ,  then  become. 


x't|  -  f(xk) 


nonlinear  plant  update 


k  ♦  i 


'"l 


+  ( i 


r. , 


covariance  of  update,  or 
a  priori  covariance  of 
state  estimate 


K 


k .  i 


-"k.i 


•  |>  '  •  I)  1  +  R  I 

k . i  k  * i  k  < i  'H ♦  i  J 


‘  K  •  I  ^  k  M  ‘  ^ 


h,xk.l'  >■  k .  l] 


quasi-linear  Kalman 
gain 


(2.;ioi 

optimal  quasi-linear 
state  estimate  after 
k  +  1  samples 


P 


k  •  i 


k  .  i 


k  ■  i 


covariance  of  optimal 
state  estimate,  or  a 
posteriori  covariance 


Note  i  hat  the  quasi  linear  approximations  are  used  only  to  calculate  the  Kalman  gam  matrix  and  the 
various  covariance  matrices  I  he  true  nonlinear  relationships  are  still  used  for  defining  the  plant 
update,  x  .  and  the  theoretical  observation  vector,  h 

2  I  Practical  Aspects  of  Designing  and  Running  a  Kalman  Kilter 

before  a  presen  tat  ton  of  the  quasi  linear  Kalman  filter  algorithm  designed  for  tile  I  top  pier 
VI. K  navigation  task,  a  few  general  comments  can  be  made  about  the  practicalities  involved  in  imple 
mentmg  a  Kalman  filter  \  more  detailed  look  at  the  practical  aspects  of  Kalman  filtering  is  reserved 
for  the  later  chapters  on  the  Doppler  VI. K  navigation  filter. 

2.1.1  System  and  Statistical  Modelling 

I  lie  following  are  some  of  the  prat  tical  considerations  that  have  to  be  confronted  when 
modelling  for  anv  Kalman  Idler  application 

ii  ( >n e  must  define  the  essential  state  variables  that  are  required  to  describe  the  plot  ess 

adequately  Including  additional  variables  that  define  obscure  second  order  cfle.  t'  (with 
an  associated  increase  in  Ihe  number  of  stales  being  estmiatedl  can  actuallv  cause  dilfi 
cullies  the  computational  burden  per  filter  cycle  could  become  excessive,  and  there  |s 
a  very  good  t  bailee  that  linear  dependent  ic-  could  m  cur  among  certain  'tale  variables, 
resulting  m  poor  state  estimation  overall 
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ii)  Bias  state  estimation  can  be  quite  important  and  can  be  implemented  quite  readily.  Assume 
an  arbitrary  variable,  v,  of  a  physical  process  has  a  bias  which  is  to  be  estimated.  A  so-called 
bias  state  variable,  Bs ,  can  be  defined:  and  the  correspond  inf;  state  update  equation  for  B. 
would  be:  Bvk  +  ,  =  Bvk  ,  with  no  plant  noise  assumed.  Several  such  bias  state  equations 
could  be  included  as  part  of  the  overall  plant  equation,  and  optimal  estimation  of  the 
assumed  biases  would  take  place. 

iii)  Modelling  the  statistical  characteristics  of  the  various  noise  processes  accurately  is  essential 
for  proper  operation  of  any  Kalman  filter.  Even  the  basic  assumption  of  constant  variance, 
zero  mean  noise  processes  is  suspect  at  time.  For  example,  a  correlated  noise  process 
modelling  might  be  desirable  and  certainly  could  be  implemented  if  required.  Statistical 
modelling  of  the  measurement  noise  processes  is  fairly  straightforward,  since  one  usually 
has  direct  access  to  the  basic  measurement  errors.  However,  correct  modelling  of  plant  noise 
processes  can  be  more  of  a  fine  art  than  a  science.  It  is  often  difficult  to  gain  access  to  the 
basic  error  quantities  that  correspond  to  the  plant  noise  as  defined  in  the  plant  equation. 
Sometimes  the  basic  error  processes  of  the  physical  system,  for  which  statistical  information 
is  known,  are  modified  significantly  to  get  them  into  the  configuration  prescribed  bv 
Equation  (2.2b).  The  main  concern  is  to  arrive  at  some  ‘ball  park'  figure  for  plant  noise 
variance  which  in  some  way  reflects  the  randomness  that  can  be  expected  in  the  chosen 
mathematical  description  of  the  dynamics  of  the  physical  process. 

iv)  Proper  initialization  of  the  Kalman  filter  is  also  quite  important  in  order  to  have  accurate 
filter  estimates  as  soon  as  possible  after  filtering  action  begins.  As  already  mentioned  in 
Subsection  2.2.2,  to  initialize  the  Kalman  filter  one  must  specify  an  initial  state  estimate, 
x  .  and  its  corresponding  a  priori  covariance  matrix.  P  •  P  is  simply  a  diagonal  matrix 

consisting  of  the  various  individual  initial  state  error  variances.  <r  , :  i  •••  1 . n.  It  is 

not  so  important  that  x  be  perfectly  accurate  what  is  important  is  that  P  eorrcet.lv 
reflects  the  expected  uncertainty  of  the  individual  elements  of  \  .  In  other  words.  P 
‘tells’  the  filter  how  much  weight  to  place  on  the  update  of  the  initial  state  estimate 
relative  to  the  incoming  measurement  information.  If  P  does  not  represent  the  true 
situation,  then  the  filter  state  estimates  will  not  be  as  accurate  as  they  could  be  also, 
the  filter  might  take  more  time  to  stabilize  to  its  stead'’  state  estimation  condition. 

v  )  The  Kalman  filter  configuration  is  such  that  it  can  handle  various  contingencies  i  e.g  -  ..hden 
changes  in  the  quality  of  the  datui  through  modifications  to  ()  k  .  H  (  .  nr  even  P  ,  .  In  lake 
advantage  of  this  capability,  one  must  have  continuous,  real-time  knowledge  of  tin- 
characteristics  of  the  various  sensors  involved,  h  may  take  a  great  deal  of  ingemni  v  and 
forethought  to  devise  appropriate  monitoring  schemes  for  1 1  m  data  transducers.  I  low  ever, 
the  effort  would  reap  dividends  by  keeping  the  Kalman  filter  ‘optimally  tuned'  througn 
refreshing  it  with  the  best  statistical  information  available  at  any  point  in  time. 

2.1.2  Numerical  Accuracy  and  Stability 

One  important  consideration  that  must  be  addressed  w  hen  implementing  any  Kalman  I  dle) 
m  a  digital  computer  is  the  numerical  accuracy  of  the  compulations.  Any  potential  an  uracy  problem 
bee  nines  more  acute  as  the  number  of  physical  states  to  be  estimated  increases.  Basically,  the  source 
of  the  difficulty  is  the  requirement  to  propagate  the  P  matrix  ar-  urately  ( v  ia  the  matrix  opera! loin 
defined  m  Equal  lolls  ( 2.2f>  I  or  ( 2.. it)  1 1  as  the  elements  of  P  decrease  to  very  small  values  with  turn 
Numerical  analysts  have  found  various  ways  to  eornb.it  the  problem  by  redefining  the  update  emia 
t  ion.-,  m  a  numerically  more  efficient  manner  I  wo  possible  approaches  re<  owing  a  lot  o|  all  on  1 1<  m  in 
t  he  literal  ure  are  square  rnol  fill  or  mg  l  Kefs,  it  lo  1  1  )  a  ml  I  I )  fact  on /a  l  mu  (  Itefs  1  2  i  o  II  i  I  Ihm 
pari leuiar  I eehmques.  compared  in  (he  normal  Kalman  update,  are  equivalent  to  doubling  tie ■  wont 
length  used  m  any  given  computer  resulting  m  an  envious  improvement  m  mum  re  al  at  ■  ur,i.  v 
I  lie  computational  effort  involved  m  these  more  advanced  mimere  al  techniques  w  soiwwii.e 
greater,  bill  is  demonstrated  lo  lie  m  II  vvorthwhih  m  a  high  dimension  Kalman  Idler  situation 
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Closely  associated  with  the  numerical  accuracy  problem  is  the  basic  stability  of  the  Kalman 
filter.  Under  certain  circumstances  iv  has  been  shown  that  a  Kalman  filter  can  be  unstable  the  state 
estimation  errors  actually  diverge  with  time.  Many  times,  this  instability  is  associated  with  ill- 
conditioning  inherent  in  the  problem  and  aggravated  by  the  numerical  inaccuracy  of  the  ordinary 
Kalman  update  equations.  Two  solutions  to  this  problem  that  are  commonly  used  are  the  following: 

i)  In  the  statistical  modelling,  include  a  sufficient  level  of  plant  noise  to  ensure  that  the  co- 
variance  matrix,  P  ,  never  gets  so  small  that  it  causes  a  numerical  instability  problem  I  which 
would  show  up  as  one  or  more  negative  eigenvalues  in  P  at  some  sample  time).  Sometimes 
plant  noise  is  included,  even  with  a  very  accurate  plant  update  equation,  for  this  very 
purpose. 

ii)  Use  alternatives  to  the  Kalman  U(Klate  equations,  such  as  square  root  filtering  or  U  I) 
factorization,  which  tend  to  propagate  a  more  accurate  P  that  remains  positive  definite 
(i.e.  positive  eigenvalues)  and,  hence,  circumvents  the  stability  problem. 


TO  A  DOPPLKK/VLF  KALMAN  FILTER  NAVIGATOR 

Based  on  the  quasi-linear  technique  described  in  Section  2..'!.  a  Kalman  filter  is  designed  for 
optimal  blending  of  Doppler  radar,  compass  heading,  and  VLF  station  phase  difference  information, 
with  an  update  rate  of  once  every  ten  seconds.  The  primary  outputs  of  the  Kalman  filter  navigator 
will  be  the  optimal  estimates  of  aircraft  position  and  velocity.  The  mathematical  modelling  is  devel¬ 
oped  for  the  navigation  equipment  presently  onboard  the  NAK  Convair  5 SO  research  aircraft,  with  the 
basic  navigation  parameters  sampled  and  processed  using  an  Interdata  7  02  minicomputer  onboard. 
The  digitized  data  is  presently  stored  on  magnetic  tape  for  post  flight  analysis;  but.  eventually,  it  is 
intended  that  the  Kalman  filter  would  run  in  real-time  onboard  the  Convair.  using  the  Interdata 
computer  (see  Refs.  1 . 2  for  computing  capabilities  onboard  the  Convair). 

•LI  Description  of  the  Basic  Navigation  Transducers 

The  following  navigation  transducers  are  included  in  the  present  design  of  the  Kalman  filter 

navigator. 

il  Decca  Doppler  Radar  a  three-beam  Doppler  radar  measures  the  three  components  of 
aircraft  velocity  relative  to  aircraft -fixed  axes.  'The  raw  RF  beam  frequency  information 
is  sampled  every  half  second.  In  order  to  resolve  aircraft-fixed  velocities  into  'straight  and 
level'  earth  fixed  components  (required  for  navigation),  the  angular  attitudes  of  the  aircraft, 
pitch  Id) and  roll  10),  are  also  measured.  Appendix  A  gives  a  complete  description  of  the 
mathematics  involved  in  converting  the  beam  frequency  data  into  the  more  typical  Doppler 
groundspeed  (  \' , ,  () ,, )  and  drift  angle  (n  |  quantities  that  are  required. 

ill  Sperry  C-l  2  Magnetic  Compass  a  dual  compass  heading  system  onboard  the  Convair 
measures  magnetic  heading.  C  ■  which  is  sampled  at  a  rate  of  twice  per  second.  The  true 
heading  with  respect  to  geographic  north.  , > .  is  then  computed  as  ,i  0  VAR.  where  VAR 
is  the  magnetic  variation  for  the  given  geographical  area. 

ml  Global  Navigation  G NS  200  VLF  Receiver  this  VLF  receiver  is  used  in  conjunction  with  a 
Rb  frequency  standard  onboard  the  Convair  to  measure  the  phase  difference  between  the 
t  ransmissions  from  the  various  U.S.  Navy  Com  mu  meat  ions  stations  and  the  Rb  clock.  These 
phase  stable  measurements  can  lie  directly  related  to  the  distances  from  the  aircraft  to  each 
of  the  VLF  st  at  ions  the  phase  measurements  for  all  stations  are  sampled  simultaneously 

every  ten  seconds.  Appendix  B  is  a  table  listing  the  essential  features  of  each  of  the  VLF 
Com m umcat ions  stations  that  can  be  received  by  the  Convair’s  GNS  200  unit .  For  more 
details  about  the  opera! ion  of  the  GNS  200.  and  VLF  navigation  in  general,  see  References 
I  a  and  1  0 


3.2  Mathematical  Development  for  the  Kalman  Filter  Navigator 

The  basic  task  is  to  design  a  mathematical  algorithm,  suitable  lor  use  in  a  computer,  which 
blends  together  the  Doppler  radar,  heading,  and  VLF  information  in  an  optimal  fashion,  along  the 
lines  of  the  quasi-linear  Kalman  filter  approach  described  in  Section  2.3.  Figure  1  is  a  very  simple 
block  diagram  representation  of  what  the  proposed  navigator  would  do.  Kach  of  the  basic  navigation 
inputs  shown  in  Figure  1  is  assumed  to  be  corrupted  with  bias  errors  and  noise  the  job  of  the 
Doppler/VLF  navigator  is  to  compute  the  best  estimates  (in  the  minimum  variance  sense)  of  position 
and  velocity  based  on  this  imperfect  data.  The  specifications  defining  the  proposed  Doppler/VLF 
Kalman  filter  implementation  are  categorized  as  follows: 

i)  Raw  Navigation  Parameters  -  the  following  parameters  comprise  the  set  of  inputs,  either 

measured  or  calculated,  that  the  Kalman  navigation  filter  will  use: 

f  ,  fh,  f.  RF  beam  frequencies  of  the  Doppler  radar,  measured  in 

hertz  (hz). 

0 ,  0  —  aircraft  pitch  and  roll  attitude  respectively,  measured  in 

radians  (rad). 

V|)()|,  —  Doppler-derived  ground  speed  (from  Appendix  A)  measured 

in  nautical  miles  per  second  (nm/sec:  converted  from  knots). 

ot  —  Doppler-derived  drift  angle  (from  Appendix  A)  measured 

in  radians. 

(!/  —  magnetic  heading  from  C-12  compass,  measured  in  radians 

(converted  from  degrees). 

(3  —  true  heading,  i//-VAR,  in  radians. 

a  +  P  true  track  angle  of  aricraft,  in  radians. 

<P h  i  =  1 . 6  VLF  station  phase  difference  between  station  i  and  Rb 

clock,  a  total  of  six  stations  assumed,  measured  in  micro¬ 
seconds  (p  sec:  0i  is  actually  the  time  it  takes  for  the  VLF 
signal  to  travel  from  station  i  to  the  aircraft;  d  =  ct  implies 
that  one  p  sec  is  equivalent  to  a  distance  of  0.162  nm). 

ii)  Biases  Assumed  -  for  modelling  purposes,  the  following  biases  are  assumed  to  exist  in  the 

navigation  parameters: 

Bv  -  bias  in  groundspeed,  Vn (> ,,  (nm/sec),  assumed  to  originate 

with  the  biases  in  f,,  fh ,  fL.  and  possibly  0,  0. 

B,  bias  in  drift  angle,  o  (rad),  assumed  to  originate  with  biases 

in  f;t,  f(, ,  fc  and  possibly  0,  0. 

Bj  bias  in  true  heading,  p  (rad);  a  combination  of  any  bias  in 

measurement  of  0  plus  a  possible  bias  in  the  specification 
of  variation,  VAR. 

B(((J  the  combination  Brt  +  B(,,  i.e.  bias  in  true  track,  n  +  p  (rad). 

B^,  i  =  1 . 6  bias  in  the  phase  difference  measurement  of  station  i  (p  sec). 


iii)  Noise  Processes  Assumed  the  measured  and  computed  parameters  are  assumed  to  have 

the  following  zero  mean,  constant  variance  noise  processes: 

uv  random  noise  in  the  measurement  of  V(|()1,,  with  variance 

<>v  ’(nmJ  / sec’ ). 

u  random  noise  in  tile  measurement  of  o.  with  variance 

<;  '  (rad  -  ). 

u  .  random  noise  in  the  measurement  of  p.  with  variance 

o  -  (rad' ). 

u  combination  of  noise  processes,  u  +  u  .  with  variance 

o  "(;’+»-( rad-  I. 

v  .  ..  i  -  1 . (i  random  noise  in  the  measurement  of  <,vi.  with  variance 

lU  sec'  ). 


Doppler  Note:  the  Doppler  biases  and  noise  processes  could  have  been  defined  in  terms  of 
the  beam  frequencies  (i.e.  f,.  fh.  f  )  and  possible  biases  plus  random  noise  in  their  measure¬ 
ment;  however,  it  was  felt  that  this  procedure  would  be  unduly  complicated.  Computer 
simulation  has  demonstrated  that  the  simpler  error  modelling  defined  above  is  perfectly 
adequate  for  the  types  of  aircraft  trajectory  expected  (i.e.  mostly  near-constant  velocity 
straight  line  or.  possibly,  shallow  curved  tracks). 

(iv)  Digital  Sampling  Rates  -  there  are  two  basic  rates  of  sampling  the  incoming  navigation 
data:  every  half  second  on  the  Doppler,  heading  data  and  every  ten  seconds  on  the  VI. F 
phase  difference  information. 

Iv)  Process  and  State  Variables  Chosen  —  the  physical  process  assumed  for  the  quasilinear 
Kalman  filter  is  the  Doppler  equation  for  updating  geographical  position  every  ten  seconds 
based  on  integrating  Doppler  velocity  components  over  that  period  of  time.  A  vector  set  of 
ten  discrete  state  variables,  x,  is  defined  as  follows: 


PLAT 

xl 

geographical  latitude  of  aircraft  (deg). 

PLOW.  - 

\2  % 

geographical  longitude  of  aircraft  (deg). 

Bv 

x3 

bias  in  Doppler  groundspeed  Inin  seel. 

B 

xl 

bias  in  true  track  ( rad  1. 

x  a 

bias  in  measurement  of  station  1  phase  (p  see) 

B  , 

x<> 

bias  in  measurement  of  station  2  phase  ip  sec) 

B  . 

x7 

bias  m  measurement  of  station  .'i  phase  (p  sec) 

»,4 

xH 

bias  in  measurement  of  station  1  phase  |p  seel 

x  |) 

bias  in  measurement  of  station  5  phase  Ip  see) 

xIO 

bias  in  measurement  of  station  (i  phase  ( p  see i 

-  15  - 


vi) 


StaU'  Equations  of  the  Dynamic  Proc  ess  —  recall  that  the  discrete  form  of  the  dynamic 
proc  ess  is  the  vector  difference  equation. 


xk+i  =  I,xk>  +  Gk  ‘  uk 


i.i.l 


i 


According  to  the  state  variables  and  process  chosen,  the  elements  of  f  will  be  a>  follow- 
(see  Appendix  C  for  more  details): 


fl,xk) 


PEATk  +  [A1  k  -  A\  ■  Bv  k]  •  s 


ml  B  ^  l 


[A2k  A1k  -«vk]  •  ‘■^»*.„k' 


xlk  +  [A1k-  A'\  -x3k] 


simxl.  I 


+  [A2k  -  A  lk  •  x3k]  •  cos(x4k 


f2(xk) 


[A1k“  A\  -ByJ 

PLONGk  -  — - 

cos  [PLATk  •  rr/lHOJ 

[A4k  ‘  BVk  -  A2k] 

cos[PLATk  •  7t/18o] 


cost  B 


sill!  B  k  l 


=  x2,  - 


[Alk  '  A\  •  x\] 

cos[xl(  •  -T/l«o] 


COS(X  lk  ) 


(3.2) 


[A,k  -x\  A2k] 

cos  [xlk  •  "  1  soj 


suit  x  1  k  ) 


fill  x  k  I 


*5\  k  x,ik 


nix  k  i 


H,.k  xlk 


fr>,x^' . fl,"xk»  15  ,k . ><  x\ . x"»k 


1 

(it) 


tk  +  10 


•  sin(«  +  /5  Kit 


A1 


k 


V 


IK)  I* 


1 

00 


tk  ♦  10 

/  V1)()1,  •  costa  +  iixlt 


All 


k 


1 

00 


10 


sima  +  ;3)dt 


A  1 


k 


1 

0)0 


tk  +  10 

I'  costa  +pldt 


Thi'  integrations  required  in  Kquation  (d.di  arc  computed  digitally  using  trapezoidal  inte¬ 
gration  (  Kef.  17)  on  the  20  samples  of  Doppler  heading  data  that  occur  in  each  ten  second 
update  interval. 

Plant  Noise  Processes  Appendix  ('  shows  the  details  of  how  plant  noise  can  he  modelled 
as  a  function  of  the  original  Doppler  noise  processes  uk  .  u  .  and  u  .  IT.e  result  is  the  two- 
element  vector. 


where 


v  k 


tk  4  1,) 

f  Ux  (It 


ll* 


,  k 


<k + 10 

.1  ( ii  +  u  )dt 


la 


The  noise  processes,  u  1  v  and  u  -  .  are  assumed  to  he  zero  mean,  constant  variance  random 

noise  with  variances  ’  and  o  *  ‘  respectively  once  again.  the  integrations  are  accom¬ 

plished  digitally  via  trapezoidal  integration.  The  auto -covaritince  matrix  associated  with  iq  . 
k  ,  is  identified  as  the  l  2  ■  2)  matrix. 


17 


r 


df\ 


i i .  r>  i 


Also,  from  .Appendix  C'|i.e.  Equation  (('15)).  the  (1  ^  matrix  is  shown  to  lie  the  (  10  /  2l 
matrix. 


•  IK  - 


r 


In  this  case,  llic  measurement  vector.  \  .  will  consist  of  the  six  VI. K  phase  difference 
readmits: 


[°  1 1.  <;'“k  •  •  •  0‘Jk] 


The  six  elements  of  h  are  identified  ;ts  follows: 


h  1  (  x  k  I  dpi  ( l'I>A  Tk ,  l’I.ONGk  )  +  B  |k  dplixlk.x2.  I  +  xf> 


h2t \ k  I  dp2ll'LAl  k .  l>LONGk  I  +  H  ,k  do2(xlk.x2kt  +  x(>k 


Ci.lOl 


hf>lxk)  dp<>(  l*LATk  .  I’LO.NC^  )  +  B  (,k  dpt'.(  x  1  k  .  x2k  I  +  \10k 


where  dpi :  i  1 . <i  represents  the  theoretical  phase  difference  i  measured  m  y  seel  for 

station  i  at  the  fjeo^raphical  location  ( l’LA'J  .  I’LONC.  i.  The  relationship  expressed  By  do 
is  not  explicit  rather,  it  is  embodied  in  a  computer  algorithm  known  as  the  Sodano  inverse 
routine  (Refs.  IK.  l‘)|  which  must  be  included  ;is  part  of  the  Kalman  filter  algorithm. 

ixi  Observation  Noise  I’roeesses  the  measun  menl  noise  is  modelled  as  the  six-element  vector. 


vk  [v  i  k  v.  '  '  v  -t.  ] 


i.t.l  1  i 


having  an  associated  ((>  X  til  auto  covariance  matrix. 


B  0 


0  ir  .  , 


Rk  K 


01.121 


0  ()••••  ir 


I 
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(x)  tjuase  Linear  State  Transition  Matrix,  ll>  -  recall,  front  Equation  (2.28),  that  the  elements 
of  <l>  will  he  defined  as, 


(')fi(x) 

dxj 


;  >  =  1 . 10;  j  =  1, 


10 


( .1.13 1 


from  the  definition  of  the  fi’s  given  in  Equation  (3.2),  <l>  k  can  he  identified  as  the 
(10  X  10)  matrix. 


1 


where 


9 

0 


0  ()fl/()x3k  Ofl/c')x-lk  0 


af2/<'lxlk  1  <)f2/0x3k  c')f2/(')x-lk  0 


0 

1 


0 

0 

0 

0 


1  0 
0  1 


(3.1  1 1 


hit  ,')x;i, 


\.'lk  •  sm(  x  lk  I  A  !k  •  eosl  x  lk  I 


dfl  ilx  1  (Alk  A3k  •  x3,  I  •  eosl  x  lk  )  (  \2k  A  lk  •  x3k  )  *  stn( x  1  k  I 


1) t‘2  <)x  1 , 


['  A 1  k  '  y\  •  x3k)  •  eosl  x  1  k )  +  (Alk  •  x3k  -  A2k  I  •  simx  lk  »] 


rr  sm(xlk  •  tr/180) 


ISO  ■  cos~  (  x  1  k  •  "  180) 


( 3. 1  ">i 


0f2  0x3, 


[a-\  •  *  sm,xlk  »]  ' 


cos(  xl  k  *  ii  1  SO  I 


0f2  d.x  lk  [i.\lk  A3k  ■  x3k  I  •  sm( x4k  )  I  A  \  ■  x3k  -  A2k  )  •  eosl  x \  l] 


eos(  x  1  k  ‘  "  I  SO) 


» it h  Alk  •  Al^  already  del'mi'd  in  Equation  1 3.3). 


J 
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xi)  Quasi- Linear  Observation  Matrix,  H  k  bast'd  on  Equation  (2.29),  the  elements  of  li  will 
lie  defined  as 


i)hi(x) 


;  i  1,  .  .  .(>;  j  =  1 . 10 

'k 


CLIO) 


From  the  definition  of  the  hi's  given  in  Equations  (0.10).  Hk  can  be  identified  as  the 
((>  X  10)  matrix. 


i')d01/Oxlk 

9d01  /()x2k 

0  0  10- 

•  0 

9(102/(1x1  k 

()d02/().\2k 

0  0  0  1  0 

•  0 

. 

..... 

•  0 

()d0t>/i)xlk 

<)d0(>/i)x2k 

o  •  •  •  • 

0  1 

Appendix  0  shows  details  of  the  explicit  computation  of  partial  derivatives  9d0i  <Klk  . 
i)d0i/<)x2k  :  i  1 . 0  based  on  output  information  from  the  Sodano  inverse  routine. 

xii)  Detailed  block  Diagram  Representation  the  complete  mathematical  development  for  the 
proposed  Kalman  filter  navigator  has  been  outlined  in  this  section.  Figure  2  shows  a  tic 
tailed  block  diagram  representation  of  the  Doppler/VLF  Kalman  filter  navigation  scheme 
indicating  the  individual  inputs  and  outputs  essentially  an  expansion  of  Figure  1  The 
following  points  summarize  the  mam  operating  features  of  this  proposed  hybrid  navigation 
algorithm: 

at  Doppler  radar  and  compass  heading  information  are  used  by  the  Kalman  filter  to 
define  the  basic  plant  process  ( i.e.  to  resolve  and  integrate  Doppler  velocity  compo¬ 
nents  m  order  to  get  position  updates). 

b|  VLF  station  phase  difference  information  becomes  the  so-called  measurement,  or 
observation ,  process. 

c)  All  the  available  data  is  used  to  compute  optimum  estimates  of  position  every  ten 
seconds,  plus  calculate  the  various  Doppler  heading  and  VLF  biases. 

d  I  The  estimates  of  bias  m  I  Joppler  grounds) teed  (  Hv  )  and  true  t rack  angle  I II  )  can  be 
used  to  correct  and  o  1  p  in  order  to  arrive  at  improved  velocity  estimates. 

V  L AT  and  V I ,( )N(  ’> . 

el  t  he  est (mates  of  bias  in  V LF  phase  ( If  i  can  be  used  to  correct  the  raw  V I.F  phase 
measurements  (oil.  resulting  in  improved  Y I.F  phase  data.  Oi.  i  1 ...  d. 


f)  If  either  the  Doppler/heading  or  VLF  subsystems  become  inoperative  during  the 
navigation  task,  the  bias  errors  will  have  been  u|>dated  by  the  Kalman  filter  to  that 
point  in  time.  This  should  mean  more  aeeurate  navigation  in  the  degraded  mode 
compared  to  no  estimation  of  biases  in  the  system. 


1.0  SIMULATION  EXPERIMENTS  WITH  TI1E  OOPPLER/VLF  KALMAN  FILTER 

['lie  important  features  of  a  computer  program  used  to  simulate  operation  of  the  Kalman 
navigation  filter  are  given  in  Section  1.1.  Other  sections  in  this  chapter  are  devoted  to  identifying, 
through  various  simulation  experiments,  the  rather  unique  characteristics  of  the  proposed  Kalman 
filter  design. 

LI  Details  Concerning  the  Simulation  Algorithm 

A  computer  program  for  simulating  the*  running  of  the  Doppler  VLF  Kalman  filter  in  real 
time  has  been  designed  and  written  in  the  FORTRAN  IV  programming  language  for  the  IBM  .'10.T2 
TSS  operating  environment.  Figure  ;i  is  a  block  diagram  representation  of  the  simulator  and  Figure  1 
shows  the  associated  computer  program  flowchart.  Some  of  the  pertinent  features  of  this  particular 
simulation  routine  are  the  following: 

Simulated  motion  of  the  aircraft  is  cither  a  straight-line  trajectory  with  constant  velocity, 
or  a  circular  track  with  constant  tangential  velocity:  velocity  and  track  specified  by  the 
user. 

The  Doppler  navigation  simulator  outputs  groundspeed.  heading,  and  drift  angle  rather 
than  the  more  fundamental  Doppler  beam  frequency  data  it  has  been  verified  that  the 
simpler  approach  used  is  sufficiently  accurate  for  simulating  the  Doppler  radar  system. 

Any  level  of  bias  and/or  random  noise  can  be  simulated  for  the  Doppler  groundspeed. 
heading,  drift  angle,  and  VLF  station  phase  difference  measurements. 

The  VLF  simulator  uses  a  version  of  the  Sodano  inverse  routine  to  compute  the  theoretical 
microsecond  phase  readings  for  the  different  VLF  stations. 

A  variable  number  of  VLF  stations  can  be  simulated:  up  to  a  maximum  number  of  six. 

A  plotting  routine  has  been  developed  to  display  the  results  from  any  Kalman  filter  simu¬ 
lation  run.  This  routine  allows  a  great  deal  of  flexibility  with  respect  to  plotting  interval, 
scaling,  and  desired  information  (i.e.  Lat/Long  position  estimation  errors.  Doppler  heading 
bias  estimation  errors,  VLF  bias  estimation  errors,  or  any  combination!. 

The  simulation  routine  also  prints  out  the  Kalman  filter  state  estimates  and  the  1’ .  *1’.  ( 1. 

K  matrices  every  ten  seconds,  mainly  for  debugging  purposes. 

A  modified  version  of  the  simulation  routine  permits  the  use  of  real  navigation  data  stored 
on  magnetic  tape,  with  the  further  option  of  being  able  to  modify  the  data  to  simulate 
desired  data  conditions. 

The  modified  routine  also  has  options  for  various  VLF  contingency  checks  (to  be  described 
in  Section  1 ,5|. 

4.2  Transient  and  Steady  State  Nature  of  the  Kalman  Filter 


J 


One  of  the  first  characteristics  of  the  Doppler/VLF  Kalman  filter  to  be  studied  in  some 
detail  via  simulation  was  the  speed-of-response.  or  transient  nature,  of  the  filter  as  a  function  of  the 
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specified  initial  conditions.  Of  particular  interest  was  the  nature  of  the  bias  estimation  response  us  the 
diagonal  elements  of  tin1  initial  state  estimate  covariance  matrix.  1’  ,  were  varied  in  size.  For  this 
study,  a  straight-line,  constant  velocity  trajectory  was  simulated  for  the  aircraft  motion-details  of  the 
simulated  navigation  conditions  are  summarized  in  Table  1.1.  Note  that  large  bias  errors  were  simu¬ 
lated  for  every  quantity  of  interest  (i.e.  groundspeed,  true  track  angle,  and  six  VLF  station  phase 
differences!  m  order  to  resolve  the  transient  response  of  the  bias  estimates  accurately. 


TABLE  1.1 


SIMULATED  NAVIGATION  CONDITIONS 


True  start  position  (Lat/Long) 

Error  in  start  position  - 
True  groundspeed  (  V(u)  p  ) 

Bias  in  measurement  of  V()()  p  — 

True  track  <«  + (3) 

Bias  in  measurement  of  tv  +  p 

VLF  stations  -  O  G  M  A  D  \V 

VLF  measurement  biases  10.0  10.0  10.0  10.0  10.0  10.0 

Noise  variance  for  V^  () ,, :  o~  v 
Noise  variance  for  tv:  tr 

Noise  variance  for  /3:  a~ 

Noise  variance's  for  VLF  stations:  (i  =  1 .  .  .  .  ,  (>) 


15.0/75.0  tleg 
0.001/0.001  deg 
250.0  knots 

10.0  knots 

15.0  deg 
10.0  deg 


/Li  sec 

1 .0  knot : 

0.25  deg" 

0.25  deg" 

1  .0  fj  sec"  :  all  i 


Recall  that,  in  order  to  initialize  the  Kalman  filter,  it  is  necessary  to  specify  a  starting 
estimate  of  the  state,  x  ,  and  the  corresponding  covariance  matrix  of  that  estimate.  P  .  For  this 

particular  simulation  study,  the  initial  position  estimates  had  an  error  of  0.001  deg  in  each  of  latitude 
and  longitude  while  all  the  initial  estimates  of  bias  were  set  to  zero.  Sets  of  variances  for  the  initial 
estimates  of  all  the  states  were  grouped  into  one  of  three  categories:  small,  medii  i.  or  large.  I  liese 
initial  conditions  for  the  transient  response  study  are  all  summarized  in  Table  1.2. 

Figures  5  to  7  show  the  set  of  Kalman  filter  state  estimate  errors  as  ;;  function  of  time  for 

the  three  different  initial  error  variance  categories.  A  careful  look  at  these  plots  reveals  that  the  . <1 

of-responsc  ( in  terms  of  decreasing  the  initial  state  errors)  increases  as  the  initial  error  variance  lev  els 
increase  ( from  small,  to  medium,  to  large).  Conversely,  one  could  say  that  the  effective  damping  of 
the  filter  increases  as  the  initial  error  variances  decrease  in  size.  For  the  particular  initial  error  van 
ances  chosen,  one  almost  has  a  situat ion  akin  to  an  overdamped  ( initial  bias  variances  0.1  ).  irit  i 
eally  damped  (initial  bias  variances  5.0).  or  underdamped  (initial  bias  variances  100.0)  response. 

( )f  course,  the  initial  error  variances  should  be  chosen  on  the  basis  of  a  priori  informal  ion  available 
concerning  possible  errors  m  the  initial  state  estimates.  The  foregoing  analysis  simple  denionstraii- 
how  the  transient  response  of  the  tiller  will  be  affec  ted  by  the  initial  error  c  o variances  that  are  loed 
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TABLE  L2 

KALMAN  FIL  LER  INITIAL  CONDITIONS  FOR  TRANSIENT  RESPONSE  S  IT  1)^ 

Position  PLAT  IM.ONd  IT). 001  7 A  ( K ) I  dey 


Bias  m  I  hippier  yroundspeed  :  B^  0(1  knot 

Bias  m  true  track:  B  0.0  dey 

Biases  m  YLF  phase  measurements:  B  li  1 .....  i > i  0.0  /j  sec:  all  i 


Noise  variance  levels  ,aine  a>  I  able  1 . 1 
Error  covariance  matrix.  P 


Small 

Medium 

Large 

Variance  of  FLAT 

P  (  1 ,1  i 

0.00001 

0.001 

1  .0  dey 

Variance  of  PIT  )N< ! 

P  (2.2i 

0.00001 

0.001 

1  .0  (ley 

Variance  of  B.  P 

id.di 

0.1 

;>.<> 

]()U  0  kne 

Variance  of  B  1 

’  t  Eli 

1)  1 

fill 

100.0  dey 

Variance  ,,|  B  P 

i  b .  b  i 

■  P  t  lO.lUi 

II  1 

b  1 1 

100  (I  ):  s, 

I  lie  res  lit  s  depleted  m  Figure*  b  to  7  make  sense  ml  ,n!  iv  e|\  .  .in.  i  I  .  at:  !"  ary  n-, :  •  li.e 
specif  v  mu  a  v  cry  small  initial  error  v  ariam  <  •  <  >n'e-p<  md  .  to  t  ell  mu  tin  Ix.n  ei.m  I : .  i  Pm  !a>  •  a  yo 
deal  of  emphasis  on  the  initial  -la  I  e  e  t  imale  and  il  -  npda  P  ■.  oiiip.t.'''  ■■  i  P  vv  ha:  .  c  v>.  n  i  P  a  mat  to. .  :  i 
incoming:  measurement  data  m mhl  h<-  I  .rmciiii.  I  Ini  -  e .  par a  a  ulai .  ' 1  a  l\a.  in.m  Pit  <  a  i  -  -a  ■  vv  to  iv.,.  : 
to  |  he  Inl'je  initial  error*  of  I  lie  I  .ia.  estimate'  <  til  •  In  oiler  h.im  I .  a  lane-  ili;t  i  P  'Her  varialn  «•  'pc 
It-  ation  implies  tlnit  very  lillle  vveiyht  .Innild  In-  put  on  tin  initial  e  timati  ■  'impaled  tie  ne  .i- 
u  re  ne  mt  dal  a  I  he  filter  then  re.it  I'  ■|ineklv.  on  'lie  Basis  nt  tin  nnoniinplaia.  m  ivifu  tin  tat  ,.e 
initial  pt  isil  ion  or  I  na  •  ern  «r  ■ 

An  old ii m  t o  I-  mure-  b  I o  7 .  a  steady  stale  -n  na!  ion  p  ev ent u  ili v  i  •  ,o  I .e« I  m  w  lie  h  :  in 
various  error  ipianl  itie~  stabilize  a!  relai  iv  e|y  small  v  allies  a  l  v  pn  a  I  response  lor  a  Kaim.n,  I'll  P-i 

I  si  lally .  durum  the  course  of  any  Kalman  filter  run.  I  here  p  an  mil  pit  i  raipieut  repmi  of  i  ei.it  iv  e:  v 
hmlmr  .1  ate  e  -t  iin.it  ion  error,  a.  I  lie  filter  at  tempts  to  adapt  to  tin-  im  on  i  am  dal  a  ion  lie  lo-e  o!  lie 
assumed  model  and  initial  <  ondiltoiPl  In  lime  tin  adaplalion  pli.pe  e  .  oii.pleied  a  steady  lap 

c  ond  1 1  ion  then  prevail',  eorresp.  mdiim  to  minimum  <  i  r.  >r  in  the  state  e  ,t  miate,  Mini y  my  the  mat  re  <  ■■ 

II  and  K  a-  functions  of  tune  c  an  also  he  instructive  vvln-n  il  comes  to  imder~t,mdmy  the  operation  <d 

a  Kalman  filler  I-  inure  s  p  i  |  ()  show  K  K  1  and  I'  as  I'uin  tmip  of  1  mn-  lor  c  ,e  h  <  d  I  he  small, 
medium,  and  la  rye  I'  i  a-es  already  <  ilcl  i  the  matrix  norm.  •  .  is  defined  a  -  1  In 1  square  tool  ot  the 

mm  id  I  lie  .1 1 1  lares  o  I  i  lie  d  i.i  l'o  i  i.i  I  elements  i  I  lie  i  ran  sp  mi  response  nature  of  these  i  plan  I  il  n-  f,  blow  s 
I  lie  same  pal  P Til  .is  d  :d  I  lie  late  est  i mates  for  the  satin  >  atcyoric  -  ol  I’  I  In  Kalman  cam  matrix.  K 


I 


24 

reaches  a  small,  steady  state  value  las  measured  by  (  K  K  1  ll(.  indicating  that  the  plant  update  process 

has  become  quite  accurate  after  till  the  biases  have  been  estimated  properly.  Furthermore,  the  co¬ 
variance  matrix.  I* .  also  reaches  a  low  level  in  the  steady  state,  implying  hi  it  the  state  estimate  error 

variances  have  become  quite  small  as  the  filter  adapts  to  the  incominy  data  ( i.c.  the  accuracy  of  stale 
estimation  has  improved  with  timet. 

1.1$  !>ias  Kstimation  and  Linear  Dependency  Problems 

It  became  obvious  very  early  m  the  analysis  of  the  Doppler  VI. F  Kalman  filter  that  the 
biases  m  \'  (1  and  o  *•  p.  15^  and  li  respectively,  could  be  estimated  quickly  and  accurately .  with 

no  noticeable  interaction  between  the  two  Doppler  heading  biases  bemy  estimated  F inures  to  7 
show  this  situation  quite  dramatically  steady  state  errors  in  the  estimates  of  1$^  ami  If  are  seen 
to  be  quite  small,  and  the  steady  state  error  condition  for  them  is  reached  sooner  than  for  the  V  I .F 
bias  estimates  of  the  same  run 

Another  phenomenon  that  was  observed  was  an  apparent  linear  dependency  relationship 
anions;  the  various  VI .F  bias  estimates  under  certain  conditions.  For  example,  the  Kalman  filler  runs 
depu  ted  m  Fi cures  ii  to  7  can  attain  be  eit.  d.  F inures  5  anil  <>  show  situations  where  the  V I.F  phase 
bias  estimation  seems  to  be  proceeding  as  expected  a  monotomcallv  decreasin',;  phase  bui'  <  -lima 
I  am  cm >r  for  each  of  the  six  YLF  stations  a>  more  and  more  data  is  processed  by  the  filter.  Ilo  . ev ■  u 
I-  mure  7 .  correspond  my  to  the  underdam  pi  .!,  fast  transient  response  ease,  indicates  a  very  dt  I'lrivii- 
situation  for  VI. F  phase  bias  estimation.  There  is  an  initial,  rapid  improvement  in  YLF  bias  esuma 
turn  for  tile  time  run  tie  0  to  700  see.  as  expected;  then,  suddenly,  bias  errors  actually  mereasi  m  t,  v  ■ 
out  of  six  of  the  stations  it  tin  ny  the  time  ranye  TOO  to  1  <sOt)  see  i  i.c.  only  YLF  station  A  bch.e, ,  «  a- 
» 1  x  pee t is  1 1 ,  I'.v entually .  beyond  1  S00  see.  i h<-  YLI-’  bias  e.st unat  ion  errors  deerea.se  to  ac<  e|  i tab  .  ■  mall 
levels.  Note  that  estimation  of  the  biases  in  \’  and  o  '  p  is  completely  divorced  from  tin-  >  He.  l 
»  hei  eas  the  position  error,  especially  Iona  it  nde  error,  is  obviously  strongly  correlated  to  it 

In  order  to  verily  the  siiyyrstrd  hypothesis  of  linear  dependency  amony  \'  l.F  phase  bias 
est  i mates,  another  Kalman  filter  run  was  executed  vv  ith  all  conditions  the  same  a>  for  the  prc\  mis 
uni  I eis  lamped,  fast  transient  response  ease  of  Future  7  I  i.c.  larye  T  m  |  ah|e  1.2  i.  except  that  no  \  I  .T 

biases  were  simulated  in  the  measurement  of  VI. T  phase  differences.  The  com  ern  was  that  the  effei  t 
heme  ohsi  rved  nnyht  simply  be  the  result  of  havmy  larye  initial  diserepanetcs  in  tile  VI. F  bias  esp 
mate,  wliieb  somehow  elicited  this  particular  response.  The  results  are  shown  m  the  plots  of 
I  ran  re  I  1  comparisons  with  Figure  7  show  that  the  V  LF  bias  error  rrsp<  uses  of  t  lie  t  wi  >  runs  are 
v  i  ft  ually  ii  lei  ii  leal,  apart  from  the  first  r>0()  see  or  so.  1  his  v\  on  Id  appear  to  rent  force  i  he  claim  that 
there  is  some  inherent  linear  relationship  amony  the  set  of  VLF  stations  chosen  that  causes  the 
-in  I  den  increase  m  VLF  I  mis  cm  irs  when  the  filter  dam  piny  is  low 

I  he  conjecture  was  also  made  that  the  ol  (served  interact  ion  amony  VLF  bias  cm  >is  m  lylit 
lie  a  fu  net  ion  of  y  coy  ra  pineal  location  heme,  it  miyiit  he  iissi  ■■  laled  with  the  yeometneal  relat  ton 
'hip  I  iet  ween  the  V  1,1  slat  lolls  and  the  aircraft  N  posit  ion.  I  o  lest  out  t  his  t  henry .  allot  her  Kalman 
filter  run  was  made  with  all  conditions  the  same  as  for  the  Fiyure  7  run  except  that  the  start  my  point 
was  in  the  middle  of  the  I  lav  is  Strait  !  i.e.  70  N.  til)  \V  i  instead  of  t  he  ( It  I  aw  a  lot  at  ion  t  t.e.  lb  N. 

7  b  W  i .  The  results  of  t  his  experiment  are  shown  in  the  plots  of  T  iyiire  1  2.  and  demonstrate  vastly 
i  hi  ferent  VLF  bias  error  and  posit  ion  error  responses  com  pared  to  the  same  results  for  the  ( it  t  aw  a 
local  ion  run.  shown  m  Fiyure  7.  Furthermore,  plot  s  of  K  F.  1  and  T  as  functions  of  tune  for 

the  I  lav  is  ; rail  run  I  see  T  ly .  1 )  reveal  siy nil 'leant  differences  when  compared  to  the  <  i irrespoiidmy 
[llol-  lor  t  he  f  It  (aw  a  run  I  see  Fiy .  1  0  I,  These  observed  dll  lire  Dees  Would  then  appear  to  lie  caused  1 1  \ 
a  ehanye  in  interaction  amony  VLF  bias  estimates  resultmy  from  the  siynifu  ant  shift  in  operatmy 
local  ton . 


In  order  to  compare  the  yeomctries  of  the  VLF  stations  for  tie  two  different  operatmy 
locations  briny  considered,  a  F<  Hi  I  K  \.\  pri lyram  was  wrilt mi  which  plots  a  map  of  a  hemisphere 
centred  at  any  specified  yeoyraphn  al  position.  I  he  projection  used  is  an  a/imulhal  eqaal  area 
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(l.c.  Lambert)  projection,  which  allows  accurate  measurement  of  hearings  and  angles  on  the  map.  This 
type  of  map  is  quite  useful  for  observing  tin-  geographical  locations  of  the  VLK  stations  relative  to  the 
operating  position  assumed  for  the  aircraft.  A  linear  dependency  among  certain  YLF  station  bias  esti 
mates  will  probably  occur  if  two  or  more  VLF  stations  are  almost  in-line  with  the  operating  position 
In  such  a  case  it  would  be  very  difficult  for  the  Kalman  filter  to  resolve  the  individual  VI.F  station 
bias  estimates  accurately  a  typical  filter  response  would  be  large,  correlated  fluctuations  in  the  bias 
errors  lor  the  V'LF  stations  involved  in  the  linear  relationship. 

Figures  1  1  and  15  show  map  projections  centred  at  the  Ottawa  location  and  Davis  Strait 
location  respectively  the  position  of  each  of  the  six  VLF  stations  is  also  indicated.  A  stink  of  the 
projection  centred  at  Ot  tawa  (Fig.  1  1 )  reveals  that  V  LF  stations  \V,  1).  and  M  are  rough  I  v  in  hie  with 
the  Ottawa  area  operating  location.  Another  look  at  the  VLF  phase  bias  error  responses  for  the 
Ottawa  area  start  location  (i.e.  Figs.  7  and  1 1 )  shows  that  the  bias  error  responses  of  those  this  e 
stations,  in  particular,  correlate  strongly  during  the  ‘large  amplitude'  region  from  7<>n  to  lsuti  s. A 
series  of  Kalman  filter  experiments  involv  mg  that  same  VLF  geometry,  where  each  VLF  si  at  ion  m 
turn  is  programmed  for  no  bias  estimation  (by  setting  the  chosen  VLF  station's  I’  element  value!.. 

zero),  veri lies  ! hat  there  is  a  consistently  strong  correlation  among  the  bias  error  responses  o|  st at a ,s 
.  I).  and  M.  The  project  ton  centred  m  the  Davis  Strait  area  (Fig.  1  5).  on  t  he  ot  her  hand  demon 
t  rates  a  VLF  geometry  vastly  different  to  that  of  the  <  )t  tawa  project  ion.  The  I  )av  i'  St  ran  |  .rn|e.  t  ;•  ,• 
reveals  pairwise  VLF  station  combinations  that  are  matrix  in-line  with  the  projection  centre  U  t  . 

D  (  L  and  A  M  (to  a  lesser  extent ) .  A  close  |<  a  >K  at  l  he  V  L  I-'  bias  error  responses  ,i  m  w  n  1 1  I  . ,  i .  1  ■  * 
indicates  definite  pairwise  correlations  for  each  of  the  three  station  pairs  cited  above  M  nove! 
further  experimental  ion  corroborates  the  existence  of  this  set  of  convlat  toio  a  mom.  \  Lb  !ai  a  m  !■■■ 
the  Davis  Strait  posit  ion. 

I  borough  invest  ittat  ion  ol  t he  \  LI*  linear  depend1  me v  problem .  under  v  a ru  *. ...  iiat  ’ 
has  demonstrated  that,  ill  general,  it  is  |  lossible  to  estimate  lour  out  of  six  large  YLF  n,.i  ->  ...m  i. .  . 

and  accurately  without  ex  c  it  mg  the  kind  of  linear  dependency  interaction  that  result  s  a :  - ,  _  , .  1 1 .  .c 
position  error  for  a  long  period  of  (tine.  For  example,  a  Kalman  filter  experiment  uus  nr-  :n  nlm 
all  conditions  were  as  described  in  Tables  LI  and  1.2  (i.e.  the  large'  P  .  u'oi,  exiepi  •  • \  1. 1 

stilt  ions  A  and  D  were  simulated  having  no  bias  ( instead  of  Dip  -ee  each  i  and  the  ■  orn  p.  .n.im.  I‘ 

element  Vill  lies  lor  A  and  I)  were  set  at  0.1  p  sec  each  (i.e.  "small  ills  1 1  ad  of  '  large  I .  |  i  ie  i  ie!  el  h 
on  the  oper.it  ion  of  the  Kalman  filter  was  to  weight  heavily  the  aee  urate  initial  c  mid  it  a  >i  ■  aitd  mat  i.  u. 
eoneernmg  the  possible  biases  m  A  and  1)  v\  bile  dew  eight  mg  the  inaccurate  initial  <  oedit'o.u  mPum.i 
Don  eoneernmg  biases  m  the  other  four  VLF  stations  (i.e.  note  that  the  mil  lal  luas  estimate  -  ot  .... 

\  LF  st  ;il  mils  are  set  to  zero  I  !■  igtire  1  (’>  shows  the  plot  s  of  i  .n-  error  c  mt  put  s  for  the  parte  alar  cm 
It  can  be  set'll  c | u it e  clearly  how  well  the  lour  large  \  I . F  biases  are  est m i:it ed  while,  a i  lie  same  nine, 
tin'  Inns  estimates  for  A  and  I)  remain  e|o,i'  to  /e  ro.  as  they  should  (note  how  nun  h  mole  -.  n,n 
the  sealing  is  for  the  Inas  error  plots  of  A  and  D). 

L  I  Handling  VI.F  Bias  Drifting 

One'  typical  source  ed  error  m  \  LF  me;isurements  is  eauseel  1 ) v  a  phase  shift  m  one  or  nioiv 
st;it  ion  phiise  dilterenee  signals  dial  h;is  not  lung  to  elo  with  the  true  mot  n  m  of  the  a  ire  ra  ft  I  he  rale 
of  this  phase  shifting  can  by  fairly  constant  in  lime  ami  a  common  eimse-  is  the  su  e  ailed  diurnal  shift 
(see  Kef.  15)  as  a  resiill  of  the  day -night  terminator  crossing  a  particular  YLF  station's  transmission 
path.  These  diurnal  shifts  can  have  rale's  as  high  as  20  p  see  per  hour  and  uin  last  for  a  couple  of  hours 
F  tirtherinore.  various  <  it  her  ionospheric  el  i  si  iirbanccs  earn  cause  phase  shi  1  ts  ol  a  me  ere  ra  lie  lorn  i  ail  ure  ■ . 

It  then  becomes  important  to  find  out  whether  or  not  the  Dopple  r  \  LF  Kalman  filter  is  configured 
to  handle'  such  VLF  phase  shifts. 

In  order  to  deal  with  the  assumption  of  a  drifting  VI.F  station  in  Ihe  eonte-xi  ol  the  Kalman 
(liter,  the-  concept  ol  a  \  LF  bias  whose'  value  could  shift  m  lime  was  considered.  Different  methods 
of  tracking  this  I  mu' -variable  bias  were'  then  tested.  For  example.  Tables  LI  and  1.1  outline'  the 
simulated  navigation  conditions  and  the  Kalman  filte  r  initial  conditions,  rcspeei ively .  for  one  si  rie-. 
of  experiments  that  were'  ii  si 'd  to  test  out  various  ways  of  handling  1  lie-  drift  mg  YLF  "t  ;it  ton  sit  uai  n  m 
1  wo  V  LI*  stat  ions,  ( .  and  M.  we  re'  simulated  to  he  drift  mg  simultaneous!  v  at  I  hi'  rat  her  high  r; it  i  s 
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of  ;?(>  /j  see, 'hour  and  72  /a  soo/hour  respectively.  The  other  four  VI. F  stations  wore  simulatod  to  have 
only  very  small,  fixed  biases  of  0.1  gi  see  eaoh.  Moth  VI. F  station  drifts  started  halfway  through  the 
Kalman  filter  run,  at  the  2500  sec  point.  Figure  17  shows  the  Kalman  filter  output  error  plots  for  this 
situation,  with  no  use  being  made  of  any  a  priori  information  about  the  drifting  VI, F  stations.  The 
detrimental  effect  on  all  VI,F  bias  estimates,  as  well  as  on  basic  position  accuracy,  is  quite  evident 
once  the  bias  drifting  starts. 


TAHI.K  1.3 

SIMULATED  NAVIGATION  CONDITIONS 
FOR  A  DRIFTING  VI, F  STATION  EXPERIMENT 


True  start  position  I  Eat/ Long) 

Error  in  start  [Kjsition 
True  groundspood  I  V.)()  (1 1 

bias  m  measurement  of  \' 

True  track  to  +  ,il 

Iha*  m  measurement  of  o  +  p 

l.F  stations  O  G 

\  1 . E  ineasiireineni  biases  0.1  0  1 

VI. F  drift  rates  .In.O 

starting  at  t  2500  sec 

\<  H  ,e  variance*  n  1  i )  km  >t  .  <>' 

ii  ii  25  1 1  iv  .  ii 


15.0  75.0  deg 
0.001  0.001  deg 
250.0  knots 

1  0.0  knots 

15.0  deg 
1  0.0  deg 

M  A  D  W 

0  1  0  10  1  II  I  p  se. 

'2.0  /J  *1-1  I  mill 

0  25  (leg 

1  0  p  M-I  .  all  I 


In  general .  1 1  u  a  *  found  I  loin  tie  am  nlat  ion  e\  penmen!  *  that  ;  i  drill  in  oin  -  or  iiinn  ol  •  ■ 

V  |,|-  I  ease* .  if  not  soineiiou  m  i  on  nted  lor.  w  ■  mid  i  aiee  I  lie  ol  her  \  I .  I  lea  e*l  in  i.ile  ■  i  o  dr  I '  .o'  a  , 

from  I  heir  true  \  allies  I  in  anahK  .  On*  would  .  ause  I  he  I  \  I  l.<  >N<  .  posit  am  error*  to  an  i ,  a  a  <  ■' 

a-,  i  lie  V  I .  F  Inns  drilling  »  outlined  \n  ml  ml  n  ■ e\  pluiiat  ion  tor  I  In*  pin- no  me  non  \\  1 1 '  now  1  •,  ■  I '  <  i  ■ 

1 1 1  lie-  Kalman  filter  ex  penmen  jint  described  i  result*  in  1-  ig  1  7  i .  lie-  I  liter  tut  rum  I .  a  .  a  mi  ,  , 

with  no  VI. F  lua*  drift- occurring  b\  t  2500  sec.  all  \  IT  biases  ar«-  esiiniati>d  ,i<  <  -irately  i  i  ■  1  ■  • 

1 1  >  their  true  l  allies  of  0  1  p  see  each  I .  so  I  lie  assoi  lal  ed  I’  llial  ri\  la  | »( 1st  eriori  ,  i  >V  anal  e  e  main'  i 

diagonal  element  *  w  ill  all  be  quite  small  In  oiler  w  old*.  1 1\  com  pi  it  mg  '  •  r\  small  Oia~  •  mu  iai.au-  ■ 

I  lie  Kalman  filter  it *el f  ■  omnler*  all  \  I . F  bia -  e*i  miale  -  to  lie  quite  ai  i  i irat i  at  l  In  -  1  -  '  i  •  : i  a  V 

I  2.501 1  ,ei  I  he  bl.l'O  .  Ill  \  I  I-  l.lt  loin  (  .  and  M  begin  III  ilri  1 1  at  I  III  s|ie,  it  lilt  lab  \  •  •  a  I  .1  i  -  1  . 

ill  II  and  '  an  ri  ase.  t  lie  i-rrors  m  l  In-  Kalman  I  liter  est  imates  i  d  t  In-si  I  ,i,ni  s  u  ;  a,  .  •  -  n  a . . 

mglv  I  h  UM\i-r.  beeaiise  t  In- i  ariaiu  es  of  all  \  I .  F  bi.n  ■■■  t  miates  an  quili  small  -...w  :  i  •  I  ■  .a  •  ii  a 

\  I  1-  t.il  i!  Ills  (  ’,  alii  I  M  are  ,1'  el  pled  bv  tie  K  al  Ilia  11  t lit  el  a-  Mi  a  1 1  rate  est  I  n  •  a  1  •  ■  -  h  ■  !  .  ,  •  •  -  :  v  ■  i  i 

.mil.  I  lies!-  errors  blllld  II 1 1  .1  lid  e\  en  t  ll.ll  I  \  I  .Ilia  I  lie  I  it  her  \  1,1  I  nils  I  st  lm.lt  ■  :  .  ■  a,  I  -  a  .  ■  -O'  I 

due  to  the  linear  relationship  existing  among  VI. I-  -tation  biase*.  t  >1  <  (mine  tn,  t  -  a  -  j  n  a  •:  ■  ■  1  ■ 

a  ro  i  iiu  I  t  he  plant  ii  pi  lal  i  ■  equal  ion  tor  \  1 ,  f  bi,n  stales,  uhii  h  n  not  ■  nrre.  I  "  i  <  i  *  o  a  .  1 1  t  ’  ■  i  '  .  . 

i  a  i  nr* 


TABLE  1.4 


KALMAN  FILTER  INITIAL  CONDITIONS 
FOR  DRIFTING  VLF  STATION  EXPERIMENT 


Position:  PLAT/PLONG,,  - 
Bias  in  Doppler  groundspeed:  Bv  - 
Bias  in  true  track:  B 

a  o 

Biases  in  VLF  phase  measurements:  B.  ( i  =  1  ,...,(>)  ~~ 

Noise  variance  levels  Same  as  Table -1.3 
Error  covariance  matrix,  P  : 

Variance  of  PLAT,:  P  (1.1) 

Variance  of  PLONG  :  P,  (2,2) 

Variance  of  Bv  P  ( 3,3  i 

Variance  of  B  :  P  (  l ,  1 1 

Variances  of  B  ,  P  (f>,f>)  *P  (lO.lOi 


■15.001/75.001  deg 
().()  knot 
0.0  dey 
0.0  p  see;  all  i 


1.0  den" 

1.0  den-’ 

100.0  knot " 
i  oo.o  deg-' 

0  1  p  set  .  all  l 


111  order  (o  compensate  for  VLF  bias  drift  inn.  without  changing  the  plant  update  model  I  nut. 
il  became  obvious  that  the  appropriate  P  matrix  diagonal  elements  would  have  to  be  adjured  during 

the  drift  period  in  order  to  counter  this  tendency  of  error  build  ups  m  the  Kalman  filter  he  nu  liuui- 
of  P  matrix  adjustment  were  attempted: 

II  Reset  I  lie  appropriate  VLF  bias  error  covariance  lev  e|s  to  la  re  value-  ai  tin-  beginning  ■  d 
the  bias  drift  period  in  order  to  'tell'  the  Kalman  filler  1  li.it  I lieso  pari  a  nlur  bias  r.imi.il' 
Would  become  inaccurate,  but  let  P  propagate  normullv  alb  1  that  I  he  in  hnjipli  ptov,  d 

to  be  unsuccessful  III  redlli  inn  the  effects  id  bl.l-  drill  I  1 1 1'ott  Ullul  el  V  alter  o|d\  .1  lew 
iterat  ions  i  if  t  he  Kalman  u  pda!  e  eij  uat  nnis.  tin  (  uni  lolls  i  I  are  \  l.l  bias  .  i  ,\  ar,am  e  level- 
w ere  once  again  at  small  values  Since  the  tu.i-.  '  were  s(t|;  drifting  a!  t hat  (••.mi.  -igi-dt*  ant 
errors  in  both  VLF  bias  estimation  and  position  estimation  then  m  ,  urn  d 

hi  Maintain  tie  appro  print  e  \  L  F  leas  error  i  ov ariaie  es  m  the  1 1  mall!',  a  I  high  value-  ;  /  ■  i  o/.g  v 

nut  tur  rnliri ■  i!n/l  />•  runt  the  lori  e-  tie-  ,  o\  ariaie  e  element-  ,d  interest  to  rem.cn  at  tie 
-ante  high  level  from  one  Herat  mu  to  tin-  next  Sin  h  a  pro,  edur,  w  a-  ton  ml  to  .  mnpeie.ile 
for  t  le  -  Ina-  drift  -  ral  ler  w  ell  He,  au.e  i  he  part  n  ular  \  I  I-  j,ia-  niuriau,  '■-  w,  re  kept  I  e.ei  1 
at  large  values,  the  effei  Pul  the  bias  dr  1 1 1  mg  were  not  I  rat  emit  I  e,  I  to  t  h,  other  \  I  I  i  ua 
estimali  s.  nor  to  lie  po-item  e  tmiab  \  anui  a-  tie  lua-  drilling  -lopped,  the  P  matrix 

va-  allowed  to  propagate  norm, ills  again  lie  o-itput  error  plot-  o|  figure  I  ,-s  an  'in 
example  ot  tin-  pro,  ed  1 1  re  being  applied  -in  i  ess  |  u)|  v  In  the  ,  use .  all  the  i  ti  ml  il  uni  -  a  I  ■ 
eleiil  e  a  I  lo  I  ho-e  of  lie  K  alma  1 1  Idler  run  shown  in  f  igi  in  I  7  land  prev  e  uisly  de-i  rile  d  i 


except  that  r  ((>.(>(  and  I*  I  7.7 ).  corresponding  to  !  nases  m  V  1,1-  stations  ( i  and  \! .  art-  m 
fixed  at  100  see’  cat'll  for  t  'iaOO  sec  As  a  result ,  no  a|>|>rccial tie  error  show ■*  u| <  m 
estimation  of  the  other  VLK  biases.  and  the  |>o-ntion  estimates  remain  accurate  lurimi 
more,  the  el  r  i  ft  myt  biases  of  V  l.K  stations  ti  am  I  M  are  actually  est  i  mated  <  |U  it.-  w  *11  on  i 
average  tile  rather  h  lyth  noise  levels  in  these  est  I  males  result  from  a  Jack  "I  an\  sinooi  1 
effect  for  bias  estimation  when  the  I’  elements  art-  set  so  limit  m  value.  A,  tuallv  tie  no 

levels  on  the  drift  nm  bias  est  miates  i  orres|  mild  to  the  \  ariance  s|  m  d u  at  ions  tm  tie  mi 

la  ted  V  | .  K  station  noise  processes  (  I  e  1  1 1  p  sc,  I  \,  it,  that  the  sii,  I  css  of  tin  -  a  p  pi  0,1. 

relies  cut irely  on  k no wmu  when  any  particular  \  I . (•  'tat  ion  o  iikel y  to  l,c  on !  i  me  in, 

is  ,  ert ;t inly  feasible  f,,r  the  diurnal  drift  case,  in  part  lcular 

\no|  her  modification  within  the  Kalman  filter  ,  ,m  I  „  used  to  elm  unate  ,m\  ado  n,  ,  It. 
from  drift  me  V  I  .!•  biases  namelv  .  change  t  he  appropriat ,  ,  ieinent '  oil  lie  II  main',  a.  i.!::..  . 

lb  i  . 1 1 !  that  tic  |;  ma i rix  md a  all  '  1  o  | he  K.iiman  filter.  \  ,a  appi  •  iximali  - 1 at  :~t  n  -  ■  u  1  in  \  are  •  •  \ 

: ,  i '  o :  i  1 1  o  i  s,  pro,  esses,  t  In  I  ■  i.ii  i\ <  imuil  ma  t  hat  •  I . i,  I  i  „■  pi  a,  e, !  on  ,  a,  it  o!  '  i  e  .mom:..  V  !  I 

Olia-e  '  i :  I'll  ■  I'e :  e  .  m  c,|  '  l  lie  111.  •  1 1 1  -  II  v  s,  nine  a  1 1  v  paite  ula  I  1 1  1 1 : . : !  r:\  d  aeoiiai  i  e  lien!  .101.1,!  :.  I 

:  :_n  :  Value  o:e  ,  an  virtually  eimimat,  tin  u-,  o|  to,  on,  pond. lie  \  I  f  -:.i',,,i  -  on 

'em  I  or  ,  \.m.  p  ■  n  I4',  v:  i.re  l1.*  a!!  tt.e  •  ,  ,  i  :  ■  ■  i  s  i , . ,  •  ■  ,  k  ,  m  .  :•.[■  t  •  s.  j ..  ;  ., ,  . .  j ,  ■  .  .  ■ 

. ■  ■  o'  Injure  ;  ,  I  X,  ep;  pell  l;  i  tl. .!  i  ai.ii  II  I  :  i  ■  o|o  I,,  -,  . ,,,  i.c  ,  . 

1  -•at.oll-tl  md  \1  li.ivclieel,  !',-i<  to  lo.lKHI,..  ■'  '  ./III  ,  ,  I  1  n  '  a  ' '  .  !  a  ■  '  e  1  "  1  .  ' 

'■  i  ii  i  a  i  at  , .  i.:  1 1  le  piaise  uea  1 1  •  I :  i  •  ■  ,  I  ,  ,  • ..  i  M  |  p  ■  m  : 1  e  K  .  m  :a  i  I  ' ,  I  -o,  .Cam!,  a  '  1  ,  : 

’  '  !':.  .1  \  a  1','Uil  .  I  In  -  I  In  t!  :u..'  \  I .  I'  01,1  n.oi  ■  ■  I  1  e  n .  Me  o'ui  \  |,|  i  ,|,|  • 

oo  ■  i  ion  i,  eii  ,  -  ma  ml  ai". -i !  \  •  ,  m;  mi'  mo:  ■  •  : : . .  •  r  r  •  ■  r  p ,  o  -  ;  i  , .  i ; .  I  to  I  a  ■  .  ' 

ile  at,  tli.it.  apart  In  mi  I  m  \  I .  I  . ,  i . .  -  ,  1 1  ,  i  ■ . !  *  .ml  M  • :,er  ,  n  ■  a  . am 

. ween  till'  iv\.i  plot'  I  Mil  .  Ill  id  it  V  lie.:  •  .In,  I  lie  ll  ma'  •  ■  •>  Me  I '  U  ,l  I  I  •  '  ,a  Me  a  '  '  •  '  '  • 

1  '  "lilef  tall  'Slmi.ile.  I  ie  1  Id  let ,  n,  I  >„  Mm  m'l  t  te  :  a.  mi  /  ,;  ,|  o.,.  le  ol  .  ,  .  me,,. 

'  :  mat  ion  I'e  .poll  -,|.  ol  t  ile  1  ird  1  im_  \  1, 1  ;  ,,t  a  m  <  •  c  . :  \l  Mod  ,  i  ■  a  '  Ml  j  o  I  t  •  e  I'  :  :  M  '■  t  t  ■" 

M  i  'raekiii:  of  I  !e  1 1 I  I 1 1  NIL  \  I  I  1  mi  -I  ee  l  ,  ,1  e  ,oii .  t  ,  a : I  o|  |;  ,  |.  „  .  rn  C  .  1 

I  ...  ir,  1  ■ 1 .  1 1  a  ■  \  I .  f  1 1  .a  e  M  ma  l  loi  i  erroi  l ,  n  •  .  mb  \l  • I  u  p  i  a  pal  y  ,,| ,  ,  ,  1 1  | 1 ,  > , .;  . ; . ,  r ■:  It.,  • 

,  t  a,  i  Moll  el'l'ol'-  1  . .  e  ,  \,  ,  .  ,  1 1 1 1  o  1  \  1 .  It.;e  i!  t ,  |  di  .1  ’  : i  „  i .  1  ■■  ■  .,  .  ,  Me  .on,  i  „ |  Ml 

h.  m  on,  1 1  element  s  i  a  V  -  n  i  a  1 1  w  1 1 1 1  •  lie-  1 1  and  M  \  I  I  pi  it.1t  .1  •  t  „'iua  a,  el  it ,  ,  I  <>  it  m  bet  n 

I  n't  ie  r  \  I  .1'  I  HU  -  e  -  I  llll.lt  ion  ,  .  1 1  t  e  n  1  pi  e<  i  tot  I  I  I  e  I  1 1.1  e  1 1  t ,  .1 1  id  \  1  I  »'  V  '  '  III  It  !  .  U  II.  I  •  I  In,  I  >' 

m.  1 1 1  \  .Iliemeiil  it  ||  in  pro,  ed  .11',  -I  e  u  lid  o: , .  v  I . .  |ere,  I  m  a  a  t  I'e  sort  -  :i  :•  a  .  win  !•  '  ■:  a  of  i 

v  I  I'  -t.it  |i  hi  -  are  of  .  ,|.  I.  ,  „  ,1,1  i  1 1 1  lilt  y  i.  v,  i.  to  'M,  point  ,■!  ll.  sieuali  tn.it  1 1  v  leu  :  I  „  ■  ■' ,  m  ; 

>  otirelv  from  the  Kalman  filter  m,ii;,iii 


ll,  >  ; ,  i  o  I  ■  I,,  i  i  I, ,  in  no, 


n  . ,  p.,!  1  e  . ,iai  \  I  I  |u.,' 


la  . 
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ml  A  VLF  slattern  transmission  may  deteriorate  in  quality,  even  to  the  point  of  a  loss  of-simial' 
status  in  the  aircraft  VI.F  receiver  fora  certain  period  of  time.  FvcnUiuliy,  the  VI.  I-  signal 
will  1  )»■  re-acquired  with  either 

a)  an  incorrect  phase  readmit,  or 

I)  I  the  correct  phase  displaced  by  an  integer  multiple  of  wavelengths  from  vv  hat  it  should 
he  l  known  as  lane  jumping). 

In  order  to  make  effective  use  of  the  VI.F  data  m  the  context  of  a  Kalman  na\  ivtat  101 1  1 1 1 1 •  -r . 
:t  is  imperative  that  some  sort  of  coni  in  net  icy  planning’  he  iletermuied  for  <  I  elec  tint;  and  hand  him  ■  a>  h 
1  d’  the  V  l.K  problems  just  described.  To  this  end.  consider  the  follow  mu  five  V l.F  Mviiarii o'  w  it i i 
siiitaesteil  solutions; 

I  I  ( "ha nee  in  VI. F  noise  character  if  one  or  more  VI . F  stations  are  delected  to  have 

increased,  or  decreased,  their  phase  measurement  noise  levels  durum  flivlit.  r<  until  estimates 
of  the  new  muse  variance  levels  can  replace  the  initial  values  m  the  appropriate  I;  matrix 

diagonal  locations  \  method  of  estimating  \  1.1  measurement  noise  variam  e-  m  liivh!  vv  .  1 1 
be  described  Sill  'sequent  |y  . 

>  Sitif’  in  VI. F  pii.i'e  if  a  dmrnai  shift  i  or  Id-  oias  ehaiuti  for  anv  oti.er  . . .  . 

detected,  toe  appropriate  1“  matrix  diaitonal  clement  .  ,m  be  p\ed  at  a  lar_i  vaiae.  -u.  i.  i.- 

I I  '•  i  u  see  the  time  \. tr Vina  VI. f  inns  can  then  be  tracked  a<  curalely  by  'die  Kalman 
t'll  ter  When  tnat  particular  bias  stops  drift  me.  the  m<  id  if  led  I’  matrix  I'kiiMi:  <  an  i»- 

allowed  to  propagate  normallv  aaam.  A  method  for  d mi mv'uishmv  between  a  addea  \  l.f 
bias  ■.inf 't  and  a  V  I .  F  noise  process  increase  will  be  -uaeested  towards  the  end  of  i  i: ,  -  i  :  la  pi  ei 

o  |  ,oss  of  VI.F  stanal  if  a  VI.  I'  station  e\|  icrielli  e,  a  loss  a  >1  -im  ial  Sit  cat  am.  tile  associated 
I!  matrix  diagonal  element  'lumld  be  increased  to  a  very  larva-  value,  ,»i  h  as  It'  .  ,n  order 

t "  ehm  mat  e  t  hat  -t  at  ion  from  the  Kalman  filter  solution.  Indication  of  a  station  dow  n' 
'talus  is  transmitted  to  the  Kalman  filter  alaoiat  hm  i  >y  way  of  a  VI.  I-  I  lav  for  ej,  h  station 

I I I  slat  ion  do vv  n  1  station  u p l  i  hat  is  inherent  i o  1 1m  d imiai  process in<:  ol  tin  \"  1 . !■ 
phase  data. 

I  '  lie  a.  q iiisil  ion  o I  VI.  1-  signal  if  a  V l.F  tat ioii  comes  I iaek  <m  line  after  iieiim  dovv  a .: lie 
I  ol  low  nut  hum  be  done  before  Usmu  i  hat  station  a  vain  in  the  Kalman  filter . 

cheek  nominal  noise  level  ol  the  station  l>\  mcasm'mv  its  approximate  noise  variance 

i  beck  \  l.f  phase  measurements  from  that  station  for  shift'  and  wavelength  imnp' 

reset  the  appropriate  \  I . F  fl.iv  vv  Imn  it  is  v erified  that  the  -l.itimi  i ■  permanent  k  ba<  k 
on  line. 

When  a  \  l.f  station's  phase  measurement  data  is  to  lie  lirnuvht  ha<  k  into  the  Kalman  1 1 i ; •  i 
-olution.  i  In'  appropriate  l(  and  I’  matrix  diaitonal  elements  must  lie  reset  , , ,  ,  on  I  invl  v 

I  he  V  I ,  I-  m  me  variance  lev  el  diet  k  will  yield  a  new  value  for  the  I !  matrix  •  I  ;av  ma: 

eli'ti  it  nt .  and  the  vv  av  f|i  nvtli  el  let  k  will  soft  out  any  ero.ss  Pi  a-  •  rrt  u  thie  in  lain  ■  am  pinv 
I  he  w  av  elen  vth  cheek  is  a  u  1 1 )  mat  n  a  1 1  y  taken  care  of  in  the  present  tl  ivital  plot  issiiit  "I 
VI.F  onboard  the  Com  air  When  the  VI.F  station  ,s  finally  n,ed  m  the  Piter  av.un,  t to¬ 
il )  1 1  i ; i I  estimate  ol  its  luas  should  be  zero.  However,  the  correspondmv  initial  VI. f  bias 
error  variance  should  be  larife  to  reflect  a  feehnv  that  there  |Ust  mmht  be  some  leas  not 
at  t  (Minted  for  m  the  phase  measurements.  Hopefully,  then,  the  Kalman  Idler  will  respond 
quickly  to  estimate  any  nonzero  bias  that  stdl  exists  m  the  datum  coniine  back  up.  even 
after  VI.F  dimtal  proeessme 


.) )  Complete  loss  ol  \  l.F  sicnals  in  >iii  I)  a  rase,  all  K  matrix  diagonal  < -1» ■  n i < •  n t s  mu.it  In*  in 

creased  to  values  like  10'  during  tin'  VI. F  outage:  the  Kalman  filter  i>  then  nav  iiraline  un 
Doppler  headum  mt'iirmalnm  only  Assuming  no  aeeurate  position  reference  exiits  al  tin- 
time  of  V  I.F  res  tar  l .  siieli  a  sit  tial  ion  would  cause  the  most  sev  ere  start -  up  problems.  1 1  all 
l  he  V  l.F  s  tat  tons  are  down  for  on!  v  a  short  period  of  tune  i  say  ten  minutes  or  less  i. 

I  toppler  headinu  nav  lttalion  ean  lie  considered  to  tie  i|uite  aeeurate  espe.  ially  w  it  It  tin- 
Doppler  heudmu  biases  well  estimated  from  the  Kalman  filter.  When  the  VI.F  stations  are 
fe  a  ei  I  Hired .  the  elleek  pn  leedllles  out  lined  111  I  I  ran  lie  followed  to  null  out  any  urns-  \  I . 
leases  and  to  establish  new  Yl.F  noise  variance  lends,  with  Doppler  luadiim  updated  imo, 

1  loll  b.  nr  Used  as  t  lie  aeeurate  reference .  Alt  \  |  .1-  bias  estimates  Would  lie  re-mit  tall/eil  0 
/ero.  with  the  eorrespi  .inline  initial  Inas  error  variances  set  at  relativ  ely  small  \  al  lie-  excep 
possibly ,  for  a  couple  of  slat loiis  that  are  know  n  to  exhibit  bias  slid t mu. 

If  all  \  I .  h  si  at  ail)'  are  dow  n  for  a  loin:  period  of  time  i  say  an  hour  or  more  i  :  In-. a  ,  me  i  a  n 
expect  Doppler  headmy  position  error  to  increase  at  a  nominal  rate  if  L!  •  ,'J  nm  imir 
I  Inis,  the  Doppler  hemline  position  will  In-  mu<  curate  when  the  \  'l.F  station'  •  on  a  n 
attain.  W  ithout  any  other  more  aeeurate  source  of  position  information,  the  Kalman  I ; ; •  .  r 
Will  simply  have  to  eoutimte  on  111  a  degraded  mode  of  opelat  ton.  I  he  \  1.1-  stall,  m-  n. 
lie  I'e-mil  lall/ed  based  on  I  lie  Iliac.  Iirate  Doppler  head  mu  p.  Is  it  nm  ;  however,  one  .  oil"  'I  1 
i  mu  is  the  fact  that  the  po-n  ion  err. >r  shi mid  not  .  out  mue  to  ii.  r ■  a  -. •  on.  e  \  I . I 
line. 


l.o.  1  In-Flight  Measurement  of  V),F  Phase  Variance 

I  lie  mi -around  measurement  of  in.  In  iduai  \  I .  I-  station  pnas.  nr  a -nr.  -in*  n;  -  tat  .  -  -  a  . 

ae.  omphsinsl  m  a  very  straightforward  manner.  Since  i he  air.  rail  is  'tat loiiary .  a  sen . f  \  l.F  m  ,  i 

second  readmits  can  be  used  directly  for  mean  md  vanaie  .  .  al.  illations.  \  .  |  < > !  abo.it  .1(1  \  ! ,|- 

measurements  1 1  e.  a  five  minute  collection  of  VI.F  data  i  w.  ••::.!  be  -  i fi  t.  :,-::t  to  arrive  a'.  .-.  r.  a  ■. 
t<  .urate  calculation  of  the  meat:  value  and  variance  I  I .< •  mean  value  -■ 1  .  a!,  tial .  .1  .m  >  ■  >. , i  ••• 

the  t  lien  ret  leal,  eoiist  an  t .  niter,  .second  value  for  th.  known  or.  nm.  t  ; ..  i  si: mi  n  -r  - 1,  i.-rnm ..  . 

inhere  nl  phase  bias  for  each  VI.F  station.  This  phase  bias  i-  a  :  to  mat allv  milted  out  a  the  b.i't-.  . 

.  .'ssii-.a  of  raw  \’  I  .F  dal  a .  so  t  lie  \'1.F  pli.i'e  biases,  at  the  si.ir!  ■  *  t  .  i  :  i ; .  v  tua  1 1  r  • : .  f !  i  l:  !  1 1 .  i  r*  -  .  < !  v.  .  \  ■  • 

to  -ero 

I n  l'liyht  measurement  of  \' l.F  pliase  .|.  us. ■  v.irian.  .  a  .  ap.ih:!;;  v  iui.ulv  ■  i.  sirao  •  w  • 
i"  i :  1 1 ;  1 1 1  u  a  Kalina1!  filter  ivi  pures  a  procedure  more  elaiiorai.  tiian  ; ! 1  it  e.i'i  .  re d.  a;  ■ 
nr.  r  if’  .  ■  fl\ m_.»iie  raw  VI.F  phase  re.idni'.:  vv  ill.  <d'  cour-  .  varv  a<  cor.tim.  to  the  fl.;  n; 
i  d  ; ! ! .  re  ■  i  ih.iiU  ii  y  n  nisi  be  i.iseil  for  t  ia  .  .1.  ulat  ion  .  ’I  no; ..  vart.nts  ••  :  ■  :  1  ■  K  ■  ' . . '  -  1 

if  Fi  piat  nm  i :  ,i  h  recall  1  iial  a  new  posit  ii  >n  update.  \  .  .  i-  .  . !  ■  •ulat .  ■<  i  i  .a  .  .  1  . .  l 1  ■  D  •  ■ 

plan:  |'i'"i  i  ■■  i  w  .lit  estimated  Doppler  head im.  o:a-.  -  taken  .lit"  . . .  .  \-  vv.  ...  i 1  >  ':■.•!  :  ... 

\  I  ••  in  a  r.  >  -e.  i  in.  I  .  I ;  si  an.  .■  must  lie  determined  for  the  -  aicuiat um  of  th.  ..iat .  ■■  i  • •'  e  ,.  - 

1  's|  1  a  i .  1 1  >  .  \  \  1.1  phase  v  anal  II  e  ,  a|.  1  l.ilioi.-  i.iii  tllec,  1  >ia  ..  e.  . !  ■ ; .  ‘  w 

I i i i  the  K.ilinai .  fill er  .  u a  .mill  siai .  . ■  a  un.iie  e. mat  i.  >n . 
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i.  1 1  v  .  k  o.l.  is  die  act  mil  nmasiired  V 1 .1'  mu  ros...  oiul  v  e.  lor  .plant  ii  \  w  I 
•  Ullle.l  lo  lake  the  General  form. 
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I  he  elements  ot  h  represent  the  theoretical  VI, I'  inn -rosecund  distances  j >1  n~.  est imiiic.-,  <il'  phase  bias 
evaluated  at  the  updated  Doppler  heading  position.  I  hits.  in  general. 

*'  ^  l'  i  s  i  H  BI  AS!  s  !  i  I .. 

for  each  VI, F  station  lining  considered.  Combining  Fa  plat  ions  I  1,‘dl  and  i  l.lil.  one  ran  then  write. 

>  h  ~  ^StH'll<ll  +  HIAS11<I  I  +  XOISE,k,  I  C%,nm 

H 1 , \ S i  s  ,  >  NOISE  ,  K  t  , 

assuming  the  Kalman  t liter  \  l,F  Inas  estimate  and  Doppler  heading  position  update  are  reasonable 
ai  eiirate.  I  Inis,  the  error  sequence.  y  h.  from  the  Kalman  filter  update  equations  actually  approx, 

mates  the  \  !,!•  tneasurement  noise  vector,  v  iFipiation  id. St  shows  this  m  a  ver\  straightforward 
manneri. 

I  he  error  seipienee.  y  h  .  can  be  used  to  acquire  statistics  that  should  reflect  the  appr<  \i 

mate  variances  ot  the  various  V],F  stations  in-flight.  Probably  something  like  ;io  Vi.F  measurements, 
acquired  over  a  live  minutes  period,  would  be  needed  lor  each  stilt  ion  m  order  to  get  a  valid  statist  ;■ 
Note  that  these  \  l.F  error  sequences  from  Equation  (  I.D  will  not.  in  general,  be  zero  mean  since  :m 
estimated  bias  might  not  exactly  equal  the  true  VLF  bias.  Very  likely,  then,  the  error  sequence  wili 
contain  some  bias,  requiring  that  a  mean  value  be  computed  before  a  noise  variance  is  evaluated 

I. *>..'!  Detecting  VI. F  Bias  Shifts 

I  he  i  rn >r  sequence,  y  h  .  can  ;il so  be  used  for  detecting  bias  snifts  in  t lie  di fferent  \  I  f 

stut  urn  phiise  measurements  Kecali  t hat  the  noise  prot  ess  inherent  to  each  of  the  V  I  .!■  microsecond 
distance  signals  is  assumed  to  have  a  zero  mean  anti  constant  variance  for  the  purposes  of  the  Kalman 
filler  i  m  piemen  t;it  ion.  ( '■enerally.  however,  the  signal  quality  of  any  given  V  l.F  .station  varies  vv  uii 
time,  as  does  the  associated  \  1. 1'  bias.  Some  ot  the  \  l.F  s  tat  am  signal  qua  I  ity  possibiht  Vs  during 
flight  are  the  following; 
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then  a  possible  bias  shift  will  be  suspected.  In  order  to  avoid  confusion  from  momentary  ‘glitches'  of 
largo  value,  y  --  h  should  be  tested  for  a  series  of  successive  values  before  the  decision  is  readied  that 

a  bias  shift  has  occurred.  For  example,  the  mean  and  variance  calculation  from  one  set  of  30  data- 
points  of  y  -  h  could  be  used  for  comparison  with  the  next  30  datapoints  in  order  to  check  for  a 

possible  bias  shift,  if  all  30  datapoints  pass  some  sort  of  tolerance  lest  when  checked,  then  a  new  mean 
and  variance  are  calculated.  1  lowever.  if  one  or  more  of  the  datapoints  do  not  pass  the  tolerance  test, 
a  further  test  is  done  to  verify  that  a  bias  shift  has  taken  place. 

A  lot  of  ‘fine  tuning’  will  have  to  be  done  in  order  to  have  the  suggested  algorithm,  and 
otner  algorithms  for  handling  VLF  problems,  work  properly  with  real  data.  Although  most  of  the 
YLF  contingency  situations  described  in  this  section  have  been  programmed  as  part  of  the  Kalman 
filter  simulation  routine,  most  of  the  verification  of  the  logic  has  been  reserved  for  future  work 


5.0  A  COMPARISON  OF  FIVE  DIFFERENT  NAVIGATION  ALGORITHMS 

In  this  chapter,  the  navigation  errors  of  various  simpler  alternatives  to  the  Kalman  naviga¬ 
tion  filter  are  analyzed  and  compared  to  the  results  using  the  Kalman  filter  approach.  A  set  of 
simulation  experiments  is  described  which  involves  comparing  five  different  navigation  algorithms, 
with  a  range  of  accuracy  specifications  on  the  basic  data  quantities.  The  five  navigation  algorithms 
are  further  compared  using  real  data  acquired  onboard  the  NAK  v’onvair. 

5.1  Description  of  the  Five  Navigation  Algorithms 

Five  different  navigation  algorithms  were  considered  for  a  comparison  study  and  evaluation. 

namely 

i)  Doppler/heading  only, 
in  VLF  only, 

liil  Doppler: V LF  complementary  filter. 

iv)  A  ‘naive’  version  of  the  Doppler/VLF  Kalman  filter. 

v|  A  ’smart'  version  of  the  Doppler/VLF  Kalman  filter  navigator. 

Brief  descriptions  of  these  navigation  schemes  are  as  follows: 

i)  Doppler  1  leading  Navigation  This  form  of  navigation  is  also  called  simply.  ‘Doppler  only', 
with  the  tacit  assumption  that  compass  heading  is  always  available.  A  Doppler  heading 
navigation  scheme  is  based  on  using  the  measured,  or  derived,  quantities  V|)()  p.  n.  v,  VAR 

(hence  j3).  as  described  in  Section  3.2.  From  these  Doppler/heading  quantities  the  rates  of 
change  of  latitude  and  longitude.  PLAT  and  PLONG  respectively,  can  be  expressed  as. 


PLAT 


0077  •  V|)()  p  •  cos  (o  +  p) 

00  ■  [o077  31  •  cos  ( it  ■  PLAT/90)] 


PLONG  = 

00 


-  (i077  •  V,)() ,,  •  sin  (a  +  (3) 

cos  (PLAT  ■  77/1  80)  •  jo077  31  •  cos  Or  •  PLAT/90)] 


(5.1  I 


-  ;{;{  ■ 


where  PLAT  and  PLONtl  are  in  the  dimensions  of  geographical  degrees;  V|)()  is  in  the 
dimensions  of  nm/see;  o  and  d  are  in  the  dimensions  of  radians. 

For  the  t’onvair  researeti  aircraft,  the  l)oppler/hea<  ing  navigation  parameters  are  sampled 
twice  per  second  this  is  then  the  sampling  rate  assumed  in  the  navigation  simulation.  A 
trapezoidal  version  of  digital  integration  is  used  to  compute  the  Doppler/heading  updates 
PLAT  (j),  PLONtl  (j)  at  times  t(  -  0.2  *  j  sec,  as  follows: 


PLAT  (j)  =  PLAT  (j  1 )  +  •  [pLAT(j)  +  PLAT  (j  1  l] 

0.5  ("-  •  -i 

PLONtl  (j)  =  PLONtl  (j  -  1 )  +  ^  •  [PLONC.(j)  +  PLONtl  (j  -  It 


(5.2) 


The  accuracy  of  this  form  of  navigation  is  directly  dependent  on  the  accuracy  of  the 
assumed  start  position  PLAT(O),  PLONtl(O)  as  well  as  the  accuracy  of  the  Doppler  and 
heading  data  used  in  the  integration  algorithm.  Any  error  in  the  specification  of  start  posi¬ 
tion  will  always  he  retained;  hut,  more  importantly,  any  bias  error  in  the  basic  Doppler 
heading  quantities  will  result  in  a  diverging  ramp  position  error  with  time. 

ii)  VLK  Navigation  For  the  purposes  of  the  YLF  algorithm  designed,  six  stations  are  assumed 
to  he  operational.  The  following  parameters  used  in  the  algorithm  are  defined: 

P  :  a  known  geographical  position  chosen  to  be  close  to  the  present  VLF  position 

(i.e.  within  a  few  nautical  miles! 

P  :  the  latest  VLF  position  to  he  computed  from  incoming  VLF  phase  measurement 

data 

P'  :  the  microsecond  distance  from  P'  to  location  of  VLF  station  j  (j  -  1 . til.  as 

calculated  from  the  Sodano  inverse  routine 

(V1  :  the  azimuth  angle  from  P’  to  location  of  VLF  station  j  (j  1 . til.  as  calculated 

from  the  Sodano  inverse  routine 

P  :  the  measured  microsecond  distance  from  P  to  the  location  of  VLF  station  j 

t» !  :  the  azimuth  angle  from  P  to  the  location  of  VLF  station  j  the  approximation 

is  valid  for  the  long  distance's  involved 

x  :  the  increment  in  longitude  in  going  from  P  to  P.  measured  in  microseconds  ip  seel 

y  :  the  increment  in  latitude  in  going  from  P  to  P.  measured  in  microseconds  tp  mvi 


For  any  given  V  LF  station,  j.  the  equation  expressing  the  \.  y  increments  can  he  written  as. 


X  •  Sill  O  V  •  COS  o  P  P’ 
I  III 


-  ;w  - 


With  six  VLF  stations  in  all,  the  following  set  of  observation  equations  is  available  to 
calculate  a  solution  for  (x,  y): 


x  •  sintij  -  y  •  cos«(  I’j  1’’ 


I  5.1 1 


x  •  sin  u,  y  •  cos  tv,  =  1’,  -  P’ 

J  (v  (>  () 

Define  A  sin  o(;  1^  costy  C  r  P|  -  I’’;  then  Equation  (5.11  becomes. 
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y  *  b, 


c 


I 


(5.5) 


A,  +  v 


having  the  least -squares  solution. 


- 

- 

“ 

~ 

(. 

6 

X 

V 

1  1 

■V 

1  A  •  B 

i  i 

i  I 

V 

\ 

A  •  C 

i  i 

= 

• 

(> 

y 

V 

1  1 

A  •  B 

i  i 

1  B ’ 

i 

i  I 

V 

1 

b  ■  r 

i  i 

_ 

The  solution  from  Equation  (5.(5)  assumes  that  equal  weighting  is  placed  on  the  information 
from  all  six  VLF  stations  being;  used.  The  position.  1’  ,  that  is  used  m  (In*  calculations  ( i.e. 

K 1 1 .  (5.-1))  is  usually  the  previously  calculated  V  l,F  position  new  Y  I.F  positions  are  calcic 
lated  every  ten  seconds,  so  I’  is  always  fairly  close  (o  I’.  Note  (hat  (he  (  \ .  y  I  solution  from 

Equation  (  5.(>)  has  the  units  of  microseconds,  and  must  be  converted  to  the  equivalent  m 
units  of  degrees  EAT;  l  ,ON(l  before  the  new  PLAT.  PLONII  can  be  calculated  I  hen 
PLAT  PLAT'  +  v:  PLOND  PLONC’  •  *. 

Doppler 'VLF  Complementary  Filter  Navigation  The  Doppler,  heading,  and  VLF  uaviga 
lion  data  can  be  blended  together  into  a  very  simple  algorithm  based  on  a  digital  version  of 
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second-order  complementary  filtering.  In  (‘sscnc  c,  the  Doppler/heading  data  is  only  used  for 
high  frequency  contributions  to  position  while  the  VLF  data  is  used  for  ‘do’  and  low  fre¬ 
quency  tracking  of  position.  I’he  complementary  filter  design  is  such  that  there  is  a 
perfectly  flat  frequency  response  in  the  filter  output.  The  basic  sampling  rate  for  the  digital 
version  of  complementary  filtering  is  0.1  cps  (i.e.  the  same  as  the  VLF)  and  the  input 
quantities  used  art*  VLF  position  (l’v  ,  ,  :  as  computed  from  the  VLF  algorithm  just  de¬ 
fined)  and  the  so-called  ten  second  Doppler  update,  UD  .  Actually,  two  different  sets  of 
input  quantities  are  used  PLATV  ,  ,  /I'D  ,  A  ,  and  PLONU^  ,  ,  'UD',  OS(  so  two 
digital  complementary  filters  run  in  parallel,  one  for  PLAT  and  one  for  PLONtJ. 

The  UD  quantities  are  computed  by  accumulating,  via  trapezoidal  integration,  the  half 
second  Doppler  velocity  components  over  each  ten  second  VLF  sample  interval.  For  the 
nth  ten  second  VLF  interval. 


UD,  A  ,.<j)  =  UD,  A  ,  (j  1)  +  --  •  [pLAT(j)  +  PLAT(j  -  1)]  ;  j  =  1 . 2 

;(j)  =  UD,  ,)N(.(j-  1)  +  ~  •  [pLONCKj)  +  (PLONGlj-  1 1]  : j  =  1. 


to  n  <; 


(5.7) 
.  20 


with  PLAT  and  PLONG  defined  in  Equation  (5.1).  Define  UD* ,  A  ,  (n)  UD,  v|(20i. 
UD* ,  o  N  (l  < n )  =  UD,  ()K  (-  (20)  as  the  Doppler  updates  to  be  used  at  the  it1*1  ten  second 

sample  time  in  the  complementary  filter.  The  general  recursion  formula  (for  i  it  her  FLAT 
or  PLONG)  has  the  form: 


I’oi;  I  (n)  =  c,  •  Pm  ,  (n  -  1)  +  C,  •  PM|.  ,  (n  -  2) 


i  ‘oil 


(HI 


+  C,  •  ^l’v ,  |  (n)  +  (1  -  a)  •  Py  |  ,  (n  1 )  -  a  •  l\  ,  ,  (n  2) 
4  •  [lID'fnl  -  LID* (n  -  2)J 


+  V 


C.Ni 


with 


2  -  5  *  K  •  ( 1  a  I 
1  +  ,r»  *  K 


(\ 


5  •  a  •  K  1 
1  +  5  •  K 

5  •  K 
1  +  5  •  K 


1  5. HI 


C, 


0.5 

+  5  •  i: 
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The  values  of  parameters  K  and  a  are  chosen  to  define  a  partic  ular  second-order  filter 
characteristic  that  is  required.  From  experimentation  with  real  navigation  data  it  has  been 
determined  that  a  damping  ratio  of  f  =  0.707  and  a  break  frequency  of  f  =  0.008  hz  gives 
good  results  (i.e.  23 'f  overshoot  and  a  90  second  settling  time)  -  this  corresponds  to 
K  =  0.0832  and  a  =  0.69952.  Based  on  these  values  for  K  and  a,  the  coefficients  in  Kqua- 
tion  (5.9)  become. 


C,  =  1.324152 


C,  =  -  0.500706 


(5.10) 


C,  =  0.293785 


C4  -  0.353107 


The  complementary  filter  defined  above,  using  the-  particular  set  of  coefficient  values 
specified  in  Equation  (5.10),  is  the  one  that  is  used  in  the  navigation  comparison  studies. 

iv)  Naive  Kalman  Filter  Navigation  The  effective  operation  of  the  Kalman  filter  is  highly 
dependent  upon  having  good  a  priori  knowledge1  concerning  the  nominal  operating  condi¬ 
tions  of  the  various  navigation  sensors.  For  example,  if  one  sensor  degrades  in  accuracy, 
and  that  degradation  is  detectable,  then  that  information  is  useful  to  the  Kalman  filter 
it  can  lead  to  more  accurate  state  estimation  than  would  occur  if  the  degradation  went 
undetected.  Therefore,  two  different  Kalman  filter  implementations  are  considered  in  the 
comparison  study.  The  first  implementation  a  so-called  naive  version  of  the  Kalman 
filter  involves  establishing  a  set  of  nominal  initial  conditions  for  the  filter  which  is  held 
fixed  no  matter  what  the  actual  status  of  the  various  sensors  might  be.  This  version  of  the 
Kalman  filter  is  completely  oblivious  to  any  changes  in  the  quality  of  the  incoming  data 
Obviously,  if  some  aspect  of  the  measured  navigation  data  changes  significant  I  v.  then  l  In- 
filter's  performance  will  degrade  accordingly.  The  initial  condition  specifications  <  Iiom-ii 
for  the  naive  Kalman  filter  used  in  the  comparison  studies  are  outlined  in  I  able  5  I 

vi  Smart  Kalman  Filler  Navigation  This  implementation  of  the  Kalman  filter  assumes  some 
method  exists  for  monitoring  the  basic  reliability  of  the  individual  navigation  sensor  V- 
soiiii  as  it  becomes  known  that  a  particular  sensor  (e.g.  I  loppler.  (12  compass,  or  Y  I  I 
station!  has  degraded,  this  information  is  used  m  the  Kalman  filter.  Certain  parameters  o! 
the  filter  are  then  modified  to  reflect  the  new  knowledge  about  the  st  at  Us  of  the  nav  igat  loll 
sensors  Included  m  t  Ills  version  of  the  Kalman  filter  is  the  capuhiht  v  of  fix  mg  anv  part  a 

ular  I’  matrix  diagonal  element  at  a  high  value  for  accurate  V  1 .1-  bias  drift  . . or . 

simply,  very  rapid  V I  ,F  bias  est  nnal  nm  The  major  it  y  of  the  mil  lal  eondit  ion  s|m  d  i<  at  ioi  i 
lor  the  smart  Kalman  filter  will  be  the  same  as  t  hose  for  the  nan  e  Kalman  filter  i.e  defined 
111  I  able  5.1  I.  except  where  noted  for  tile  part  leular  eondit  lolls  oil  t  lie  < hit  a  being  used  III 
the  comparison  si  inly . 
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I'ABLK  5.1 

INITIAL  CONDITIONS  FOR  NA1VK  KALMAN  HI.  I  KK 


Position :  PLAT  /PLONG  ,  15.001/75.001  deg 

Bias  in  Doppler  groundspeed :  Bv  --  0.0  knot 

Bias  in  true  track:  B  0.0  deg 

O  O 

Biases  in  VLF  phase  measurements:  B.  ( i  =  1 . 6)  0.0  p  sec;  all  i 

Noise  variance  for  V(M) tr  v  -  1.0  knot* 

Noise  variances  for  a,  jj:  o’  ,  o'  .  0.25.  0.25  deg* 

Noise  variance's  for  Vl.F  stations:  o’  (i  =  1 . 0)  1.0  /j  sec*  .  all  i 

Krror  co variance  matrix :  P 

_  o 

Variance  of  PLAT  ,,  PLONG o  :  P  (1,  1),  P  ,t2,  2)  0.0001,  0.0001  deg*’ 

Variance  of  B.  :  P  (3,  3j  —  10.0  knot* 

Variance  of  B  P(i(  l,  t )  -  5.0  deg* 

Variances  of  B.  p  :  P  (5,  5)  —  P  ,  10.  10)  0.1  p  sec*  ;  ,ii!  ' 


5.2  Description  of  the  Different  Types  of  Simulated  Navigation  Data 

The  four  different  type's  of  simulated  navigation  data  to  he  considered  are; 

0  Best  quality  data, 

u)  data  with  large  Doppler/heading  bias  errors 
in)  data  with  large  VI, F  phase  bias  errors,  and 
iv)  data  involving  VLF  station  drifts. 

Two  different  aircraft  trajectories  are  used  in  the  simulation  studies,  namely. 

a)  straight-line  track  with  constant  velocity  and 

b)  circular  track  with  constant  tangential  velocity. 
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Detailed  specifications  on  the  various  types  ol  simulated  data  are  as  follows: 
i)  Best  Quality  Data  -  The  conditions  simulated  for  the  navigation  transducers  are: 
a)  Doppler  radar  system  — 

Bv  =  1.0  knot,  o’v  =  1.0  knot" 

B  =  0.5  deg,  o’  =  0.25  deg2 

l>)  C-12  compass  system  — 

B  =  0.5  deg,  a2  =  0.25  deg2 

e)  VLF  system  —  stations  used  are  O  G  M  A  D  W 

B.it  =  0.1  /a  sec,  «'  i  =  1.0  p  sec2 ;  i  =  1,  .  .  .  ,  6 

ii)  Large  Doppler/Heading  Bias  Errors  —  The  conditions  simulated  for  the  navigation  trans¬ 
ducers  are: 

a)  Doppler  radar  system  - 

Bn  =  10.0  knot,  o:  s  =  10.0  knot2 

B  5.0  deg,  <r  =  2.5  deg2 

I > )  C-12  compass  system 

B  =  5.0  deg,  a  2.5  deg" 

c)  VLF  system  specifications  same  as  in  i). 
lii)  Large  VLF  Phase  Bias  Errors 

at  Doppler  radar  system  specifications  same  as  m  i). 

L)  (’- 1  2  compass  system  specifications  same  as  m  i). 

cl  VLF  system  specifications  same  as  m  iic.vcept 

B  ,  10.0  p  sec,  i r  25.0  p  sec  fur  \  LF  stations  ()  and  or  G. 

iv)  VLF  Station  Drifting 

al  Doppler  radar  system  speed n  at i< ms  same  as  m  ;|. 

L)  C-l  2  compass  system  sjiecificat ions  same  as  m  ii. 

c  I  V  LF  system  spec i final  ions  same  as  in  i )  r.ur/it 

B  f  changes  linearly  at  1  0  (I  p  sc  hour;  <>'  3.0  ;j  sec'  for  VLF  -tation 

< )  or  G 


I 


Information  concerning  tin1  two  different  aircraft  trajectories  simulated  is  as  follows; 

a)  Straight-Line  Track,  Constant  Velocity 

Initial  Position  15.0'  LAT,  75.0  LONG 

Krror  in  Assumed  Initial  1‘osition  0.001  LAT,  0.001  LONtl 

(Iroundspcod  250  knots 

True  Heading  15.0 

h)  Circular '  Track,  Constant  Tangential  Velocity  This  type  of  aircraft  trajectory  is  useful 

for  simulating  a  strong  acceleration  situation  for  the  aircraft.  Note,  however,  that  this 
particular  manoeuvring  would  never  occur  for  any  length  of  time  under  normal  flymg 
conditions. 

Initial  Position  15.0"  LAT,  75.0"  LONG 
Tangential  Velocity  250  knots,  clockwise 
Radius  of  Circular  Track  10.0  run 

Centripetal  Acceleration  2.9.'5  ft 'sec  or  1 ,7.15  knot  sec 
5..'5  Results  from  Simulating  Rest  Quality  Data 

Simulation  runs  were  conducted  using  the  best  quality  navigation  data  on  the  five  different 
navigation  schemes  being  compared.  Both  the  straight-line  and  circular  tracks  were  considered  a-  well. 
In  the  case  of  the  straight-line,  constant  velocity  trajectory  there  was  no  difference  between  the  naive 
and  smart  versions  of  the  Kalman  filter,  so  only  one  of  them  was  used.  Figure  20  compares  the  total 
position  errors  for  each  navigation  algorithm  as  a  function  of  time,  over  a  .'5000  sec  run  i  NO'l  K  .  total 

position  error  [l  LA T  KRROR  L  +  (  LONG  KRROR)"]  1  "  ).  From  Figure  20  it  can  be  seen  that 
nav igal  mg  on  Doppler  heading  alone,  even  with  reasonably  good  Doppler  heading  data,  result  -  in  a 
significant  ramp  type  of  posit  ion  error  due  to  i  lie  biases  m  ground  speed  and  head  mg.  Nav  igat  mg  on 
VLF  stations  alone  leads  to  a  bounded  error  with  time  the  error  level  shown  here  for  VLF  would 
correspond  to  a  very  good  quality  VLF  sit  ua  l  ion.  When  the  Doppler  VLF  ‘  u  tuple  mem  ar\  I'1  It  it  i- 

u  sec  I  (i.e  C(  >MI'|.  in  Fig.  21 1 1  the  average  error  level  decreases  slightly  .  and  t  In  re  i-.  a  bit  .  u  a  . . . 

effect  on  the  VLF  error  from  tin  low -pass  ac  t ion  of  (he  filter.  The  bottom  trace  m  |  igui  •  2n  how  - 
(lie  Kalman  filter  result  clearly  much  superior  to  any  of  ihe  other  n.tv lga'ion  vh<  nn  o  '  , ....  , , ; 
average  error  level  and  s  moot  h  ness  of  error  response.  Not  ice  the  t  v  pa  al  Kalman  lilt  err  a.  •  1 

results  m  a  slight  !y  higher  error  during  the  first  few  hundred  second-  ot  'la  run  a  -  1 1 .  <  i  .ni.u  ■'  ■■  !•> 
t he  meoinmg  data. 

Figure  2  I  shows  similar  results,  again  for  the  best  quality  data,  vv  hen  ' .  .  .  a  u  ar  ’  a.  i.  vv  " 

e.  nisi  ant  I  a  ill1  en  1  la  I  velocity  is  being  simulated  In  this  case,  both  a  na  i\  •  uni  a  - anal !  i  e .  ■ .  I  ' 1 

Kalman  filler  are  considered  m  the  com  pari  son  plots,  ]  In  error  behav a  our-  for  It..-  i  ‘  •  a  ■ i 

V  L  !•  alone .  and  Doppler  VLF  ■  omt  1 1  ■  ■  1 1 1  •  ■  1 1 1 ;  i  r\  filter  eases  are  aboui  vv  hat  vv  on  Id  n.  .  ■  i  •  .  '  ■  d  I  I  >.  .pc 

err  T  I  -  const  ran  ied  be  an-e  ill  the  cm  tllar  t  r :  1 1  ■  ■  <  torvl:  but  the  total  pos.;  ton  eft . ..  |... .-  ■  ■  i  .  i , 

Is  alma  1 1  filler  is  i  al  her  interest  mg  For  I  iia!  ease,  t  i,e  posit  mn  .it.  u  a,  •  ualiv  an  a  •  a  .  -  w  "  e  ■  n  • 
rat  i  nr  sign  1 1  lean  I  level  it  even  look  s  a  ■  though  l  lie  error  e-  s|o  wT,  <1 1  v  eria '  o;  w  if  n  :  .  im  ■  I  •  ■  •  o 
for  th is  becomes  apparent  when  one  considers  the  tvpc  ot  aireral l  1 1 .■  t< -■  : < n  s  tli.c  i  ■  ,'t  an, ..i.c .  . . 

Ret  all  I  hat  tin-  urn  ulaled  circular  I  rat  k  results  m  a  i  mist  an!  cent  I  ipet  a  I  n  .  < -ii -r.it  re  i  . ,  t  b.  f  . 
or  1  7. 'in  knots  sc«  for  the  aircraft  I  h is  is  a  fairly sigmfn  an!  -n  .  .  lerat  g  >n  in •  ■  ,.  •  i  .  |  i 

heading  plant .  Iia.setl  on  veloiity  measurement  s.  will  in  it  tie  hi  arlv  a  a.  .man  a  mil,,  'ra.n  l.n. 

I  oils!  ant  Velocity  ca.se.  Nevertheless,  tile  naive  Version  ol  the  Kalman  biter  a  .  -  a  a  c  -  ;•  .  |  1 

beading  plant  retains  its  nominal  accuracy  as  defined  by  the  noise  v an.n..  ■  -(■■■■  1  .  .a  ,. \ 

o  .  and  ,  I  1 1  .e.  i  n  I  able  >  1  |  (  )bv  ious|  v .  1  In-se  s|  .et  a  |  n  at  n.n  -  an  un  on .  .  :  Pt  ;  I .  ■  ■  '  .  t .  ■  .  ..  i ,  1 1 .  i . . 

lie  d  ion  1  ak  mg  j  dai  e,  am  l  a  mart  version  ot  !  lie  K  alma'a  t  ill  'I'  i  i  a  I.e.-.  I .  ■  i  i  ■  ■  -  \ .  t ,  1  b. 

I  >r*  it  lien  l 


to 


For  till'  smart  Kalman  filter  a  pour  quality  plant  is  assumed,  and  this  information  is  ,  mi 
veyed  to  the  filter  hy  respecifymu  n  100.0  knot  ,  o  lifj.O  den  ,  and  n  2n  0  dee 

These  changes  in  initial  eonditioiis  nive  a  much  better,  and  more  stable,  total  position  error  plm 
(shown  m  the  bottom  t  raee  of  Kin.  'dll.  ill  is  posit  ion  ern  ir  trace  shows  a  sinmlicai it  m  ,  roein.  m 
i -oni pared  to  all  the  others,  hut  the  improvement  is  not  a-  drama! ie  as  in  the  -t rainhl  line  1 1 aje,  t < .  1 
ease  I  shown  m  Kin.  20)  I'he  reason  for  this  is  the  fart  that  the  hasie  plant  update  equal  ions  h.n ■ 
deteriorateil  m  aeeuraey  lor  the  circular  track  situation,  and  the  Kalman  filter  <  anuot  he  .  \p.  .  i,  .j 
do  as  well  under  the  circumstances.  Specifying  basic  plant  accuracy  as  a  function  ot  tin-  !  \  p<  ,1 
aircraft  trajectory  taking  place  is  only  one  of  the  capabilities  that  a  smart  Kalman  Piter  11110;  n.w, 
w  ill  he  shown  subsequently , 

1  Results  from  Simulatmn  l,aru«*  Doppler/lleadinn  Biases 


The  simulation  results  from  navigation  data  with  laruc  Doppler  headmn  i.ia  ■  tioi  -  an  d 
played  m  Kin  tires  22  and  2d.  Finnic  22  compares  tin  five  different  navigation  schemes  t .  >■  1 1 1  > 
straight -line  track  case.  For  navi^at  ion  w  1!  Ii  Doppler  alone,  1  lie  err<  *r  build  up  1 1  lie  1 .  >  la r_>  i  topple  1 
heading  biases  is  quite  dramatic.  Naviyati  >11  error  results  foi  \  '  l.K  alone  -lay  tin  same  ,n  lietoi.  .  e 
the  naviuation  errors  for  the  Doppler  VI, K  eomplenientarv  Idler  I  he  lame  lloppi,  1  1  .-ad"...  n  1 
errors  do  not  affect  the  opr  rat  ion  of  the  complement  ary  filter  because  onl\  t  lie  hi  cl.  1 1  eq  ie  ,  \ 
trih ill  1011  from  the  Doppler  heading  system  is  used  I  he  naive  and  smart  version'  <  d  i :  •  K  m  ,c  ! 
produce  about  the  same  error  level  in  the  steady  slate,  and  both  are  ,1  -lym In  ant  nupi ov .  un  .v 

the  other  naviuation  algorithms.  The  only  difference  in  the  error  response-  o!  ;h.  two  v.  . . . 

Kalman  filter  is  that  the  transient  res| >o»ise  for  the  first  dot)  sec  or  so  i-  a  lot  t.i-b  r  ,t,  :m  ■  ■  ■  1  ' 

smart  version.  'Ill  is  is  due  to  I  lie  fact  that,  lor  the  smart  version  of  the  filler,  initial  mud  tar  10 

respect  lied  as  <r  ^  10.(1  knot  ,  n  2. a  den  ,ir  2.0  den  .  I*  id.  .!i  loll  11  kmc  m.i 

l‘  <l.  D  dt)./)  dejr  to  take  advantage  of  tlie  a  priori  knovvlcdi.''  licit  Dopph  r  lieadmc  bia-e-  w  , 
siumtieant  (so  that  a  faster  transient  response  should  he  used  when  estimation  lie  mi 


K  inure  2d  compares  I  he  five  navigation  alnori  thins  for  t  h<  .  in  ular  trad  <,iit,iic:  \.  ■  1 

ern >r  result s  for  Doppler  alone.  V l.K  alone,  and  the  Doppler  \  l.K  eom|>lem<  ntury  t  liter  show  ■  r.  . 
surprises.  In  spite  of  the  Iaree  Doppler  headmn  biases,  errors  m  Doppler  only  navjaat  eui  1.  m  cc 
reasonably  bounded  mainly  because  of  the  10  11m  radius  circular  track  otherwise,  tin  I  )■ .  1  •  j  ■  i .  1 
naviuation  error  would  nrovv  at  a  much  faster  rate  The  naive  and  smart  Kalman  f : It .  i  tv-nli-  an  vi. 
similar  to  those  shown  in  Kin  tire  21  ( i.c.  for  best  quality  data  and  a  circular  Hack)  1  he  m  unma!  ua  v. 
Kalman  liltcr  specifications  on  the  Doppler  headmn  plant  correspond  to  ,1  plant  update  e. | u .  1 1 1. >  1 
assumed  hy  the  filter  to  he  more  accurate  than  is  really  the  ease  A  -  a  consequence,  the  ( •  <  •  - 1 1 1 . . : .  1  mu 
nrovvs  with  t  line  111  fail ,  the  Kalman  filter  appears  to  lie  close  to  uni  ahilit  \  Modi  I  led  -pi  e,(  e  .c  .1  e 
on  the  plant  for  the  smart  Kalman  filter  ( t lie  same  ones  as  for  the  best  quality  data  1  1 10  11l.1t  tr.nK 
ease)  red i I y  the  situation  by  mercasilin  the  level  id  plant  noise  assumed.  whuh  has  a  -tabilc  iii; 
m  1 1  tie  tier  on  t  he  I  liter  response.  Not  e  t  hat  t  lie  smart  Kalman  1 1  Iter  err  1  >r  response  1 ,  m  1 1  v  a  mar.  11 1  a! 
im|>rovement  over  that  of  the  i  a  implement  ary  filter  appn  >aeh  due.  no  doubt .  to  the  pom  ,  pin  in  v 
plant  updatmn  for  the  circular  manoeuvring. 

For  completeness.  Kinure  2  1  shows  plots  of  the  actual  Doppler  headmn  luas  errors  m 
attemptmn  to  estimate  R  and  B  usmn  the  Kalman  filter.  The  runs  used  correspond  p>  the  r.  mill- 
from  Kinure  22  for  larn''  Doppler  headmn  biases  with  a  strainht  line  track  Kinure  u  |  mdu  ates  1b.1i 
the  error  response  is  much  faster  for  the  smart  Kalman  filter  compared  to  the  naive  version,  dm  to 
the  ehannc  m  initial  conditions.  Nevertheless,  for  both  naive  and  smart  versions  o|  the  filter  tie  err.  u- 
in  estimatmn  the  larn*'  Doppler/heailmn  biases  are  quite  small.  The  same  small  luas  error  level-  u.  .  in 

even  when  the  circular  t  rack  manoeuvre  is  used  in  t  he  simulat  ion  runs  An  obvious  prad  n  a  I  . . 

ill  which  Doppler  headmn  biases  heroine  sinnifieant  occurs  when  maniietie  variation.  V  \R.  1-  -pm  died 
incorrectly  the  Kalman  filter  will  quickly  estimate  any  obvious  bias  in  n  *  ,i  from  this  sourer  ,d 
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5.5  Results  from  Simulating  Large  VI.F  Station  Biases 

Simulation  results  for  navigation  data  involving  large  Biases  in  certain  VLF  station  phase 
measurements  are  compared  m  Figure  25  (for  the  straight-line  trajectory),  with  VLF  stations  ()  and  ('■ 
simulated  to  have  phase  Biases  of  10  p  see  each.  The  effect  of  these  two  VLF  Biases  is  quite  evident 
for  the  VLF  alone  and  Doppler/VLF  complementary  filter  runs.  In  Both  eases,  an  average  total  posi¬ 
tion  error  of  1 .0  mu  occurs  Because  of  the  significant  Biases  ill  the  two  VLF  stations.  Note  that  the 
complementary  filter  still  tends  to  smooth  out  the  VLF  data.  But  it  can  do  nothing  about  the  VLF 
bias  errors.  Oil  the  other  hand,  both  versions  of  the  Kalman  filter  show  position  error  improvement 
with  time.  The  naive  Kalman  filter  response  is  quite  sluggish  because  of  the  nominal  initial  condition 
variance  levels  for  all  VLF  bias  estimates,  o'  -  0.1  /u  see-  ,  all  i.  I  lowever,  with  appropriately  large 
initial  condition  variance  levels  for  biases  m  VLF  station  O  and  (!  (i.e.  o-  (  _  100.0  p  sec-  ).  as 

defined  for  the  smart  Kalman  filter,  the  speed  of  response  of  the  error-versus-time  plot  is  greatly 
enhanced,  and  the  steady  state  total  position  error  is  quite  low  . 

As  a  further  check,  navigation  data  for  the  straight  line  trajectory  was  simulated  with  both 
large  Doppler  heading  biases  and  large  VLF  biases  m  stations  < )  and  (I.  This  w  as  done  in  order  to 
verify  that  the  superimposed  data  response  was  essentially  the  same  as  the  sum  of  the  individual 
Kalman  filter  responses.  With  the  VLF  bias  errors  predominating,  the  output  error  response  for  tile 
superimposed  data  was  virtually  identical  to  that  shown  m  Figure  25  (the  only  exception  being 
I  top  pier  onK  nav  igat  ion  w  here,  of  course,  the  large  Doppler  heading  bias  errors  dominate  I.  Figures 
2b  and  27  show  the  complete  set  of  Kalman  filter  error  responses  for  each  of  the  naive  and  smart 
versions  of  the  filter  corresponding  to  this  superimposed  navigation  data  situation.  From  the  naive 
Kalman  filter  error  outputs  of  Figure  2<>  it  can  be  seen  that  the  Doppler  heading  biases  are  estimated 
pmkly  and  ,u  curate  iy ,  w  li  lie  VLF  bias  estnriat  ion  is  much  more  sluggish.  There  i'  also  an  obv  ions 
interaction  among  various  VLF  stations  as  a  result  of  the  linear  dependencies  that  are  known  to  exist 
i )  i ;  the  other  hand .  I  he  smart  Kalman  filter  error  out  put  s  (  Fig.  27  i  look  good  right  across  the  board 
the  advantage  of  having  accurate  a  priori  knowledge,  especially  <  omen  i  mg  VLF.  i'  quite  evident  I 

a.h  If e'ul! s  from  Simulating  VLF  Station  Drift 

Sim  u  lated  nav  igat  ion  data  with  VLF  ’  at  ion  O  drift  mg  at  the  i  ate  of  10  p  sec  hour  was  used 
lor  tin-  i  o m par i so 1 1  plots  of  total  position  error  shown  m  Figure  2S.  1  lie  effect  <d  the  constant  \  LF 
drift  rail  i-  <  learly  seen  in  the  VLF  and  complementary  filter  plots.  A  naive  version  of  the  Kalman 
filter  product  s  an  output  error  which  appears  to  stabilize  at  a  level  of  about  O.d  mil  However,  a 
I  >n  iperlv  programmed  smart  Kalman  filter  1  i.e.  with  l’|  5.  5 1  I  ixed  at  1  00.0  p  see  for  tile  cut  ire  runt 
results  m  a  very  small  total  position  error,  as  shown  in  the  bottom  trace  of  Figure  2S  Similar  results 
ota  it  r  if  VLF  si  at  ion  (1  is  drift  mg  instead  of  si  at  ton  (  >  Figure  20  -how  -  the  complete  set  ol  esi  uuatjoii 
errors  for  the  naive  K  ulmati  filter  run  with  VLF  'tat  ion  ( >  drilling.  I  In  associated  VLF  bias  ern  >r  plots 
md  lent  e  t  hat  t  here  is  a  st  rong  interact  ion  among  the  various  VLF  bias  est  i  mates  caused  by  the  drift  mg 
ot  station  ( )  Figure  do  displays  the  smile  error  quant  it  ies.  but  for  tin  smart  Kalman  I  liter  case.  Not  ice 
low  the  VLF  bias  errors  are  mm  h  more  stable  and  hardh  drill  at  all  <  ompaivd  to  the  naive  Kalman 
I  liter  case  Note  also  that  I  lie  procedure  of  fixing  l’(  5.  5  l  at  I  ( Ml  n  p  se.  means  !  hat  I  lie  basic  mu  sc 
process  of  V  |. F  slat  ion  <>  I  n  ’  5  0  p  see  |  is  present  m  t In  est  mi  it  mu  error  of  If  I  Inis,  t he 

normal  sin  out  lung  effect  of  the  rei  ursion  formula  for  est  i  mat  mg  H  i  l-.q  l  '*  .  b  i  i  bv  pa-sol.  ,  ails  mg 
If  to  tie  est  Dilated  in  a  noisy  fashion  .  -hist  l  In  same.  I  In  average  .  nor  in  •  -1  uual  mg  It  is  <  lose  to 
zero  III  spite  ol  the  large  drill  rale  being  simulated. 

5.7  Results  from  l  sing  Real  Data 

About  an  hour's  vv  ort  h  of  real  nav  igat  ion  dal  a.  i  ollei  ted  onboard  the  ( 'miv  air  aSU  research 
mririft.  has  Inin  analyzed  using  the  various  navigation  algorithms  already  defined  lie.  Doppler 
in  ailing  navigation.  VLF  navigation.  Doppler  VLF  1  omph  mentarv  Idler  nav  igat  ion.  naive  and  smart 
Kalman  filter  navigators  |  The  nav  igat  ion  data  was  i  o  I  [cried  m  the  v  u  nut  y  ot  (  It  t  awa .  and  the  type 
ol  aire  raft  I raiectory  involved  w vis  a  series  of  inert r.u  k  patterns  pa>'inr  over  well  known  visual  land 
marks  such  ,i'  airport  In  m  mis,  airport  V( )|{.  and  riinwav  mtersei  iiois  I  host-  visual  on  tops  are 


nei  essury .  nf  course.  m  order  to  have  reference  point*  for  eslablishmt;  iiavmatinn  error  a*  a  function  of 
tunc  m  the  case  of  the  real  data.  Table  5.2  shows  a  list  of  the  visual  on  tops  in  the  sequence  in  w  hu  h 
they  were  overflown,  together  w  ith  the  time  anil  correct  irecmraphical  location.  Note  that  the  accuracy 
of  t he*' ■  on  tops  is  felt  to  he  within  0.10  uni.  The  table  indicates  that  there  are  about  57  minutes  of 
useable  navigation  data  from  the  known  start  position  to  the  final  on-top. 


TABUC  5.2 

INFORMATION  ON  THK  VISl’AL  RKFKKKM  K  POINTS  FOR  IMF  NAVIGATION  SIT  1)5 

Type  of  On-Top  Time  from  Start  Geographical  Location 


Intersection  If VV  25-22 

0  secs 

15 

l.s’57" 

7  r> 

29  55 

Ottawa  YOlt 

290  secs 

15 

20  20" 

7.7 

52  50 

Kinhurn  Beacon 

5  10  secs 

15 

25  00" 

7t> 

OK  5.S 

Arnprior  Bridge 

1  1  20  secs 

15 

20  00" 

7(> 

21  00 

Kinhurn  Beacon 

1210  secs 

15 

25  00 

7C> 

OK  58 

Oitawa  VOIt 

1520  secs 

15 

20  20 

7  f) 

52 '50 

Intersection  RVV  25-22 

1  790  secs 

15 

1  S  57’ 

7  5 

29  55 

l  ’plands  Beacon 

1  9, SO  sees 

15 

12  15" 

7  :> 

29  .20 

l  plands  Beacon 

22  10  secs 

15 

12' 15" 

7 5 

29  20 

Ottawa  Beacon 

2790  secs 

15 

21  20" 

7  5 

22'  11 

Intersection  It W  25  22 

2970  secs 

15 

1 K  5  7 

7  r> 

29  55 

It ideau-Oiirleton  Racetrack 

2  1  20  secs 

15 

1  7’  Ik" 

75 

20  15 

Ottawa  Beacon 

2 1 I 2  secs 

15 

21  '1,0" 

75 

22'  1  1 

For  the  particular  naviftat ion  data  collected,  the  V I.F  situ  mils  available  were  I ..  M .  I ).  G.  \\  . 
and  If.  Figure  111  shows  the  relative  locations  of  these  VI, F  stations  usiim  a  Lambert  projection 
centred  at  Ottawa.  It  can  be  seen  from  this  projection  that  the  VLF  geometry  is  not  the  best,  with 
many  of  the  stations  almost  in-line.  The  possibility  of  VLF  linear  dependencies  w  ill  then  lie  ipnte  real, 
and  this  fact  must  lie  taken  into  account  when  using  the  Kalman  filter  approach  VLF  urnundrun 
statist ics.  based  on  12  samples  for  each  station,  were  computed  by  monitoring  the  VLF'  receiver  jii't 
[irmr  to  the  navigation  flight .  As  well,  a  comparison  of  t he  raw  VLF  was  m.ide  bi-iuei  n  the  start  t  mm 
did  a  and  the  VLF  data  at  the  2970  sec  point  (both  of  t  liese  positions  are  the  If  \\  25  22  mtersei  tim.i 
t  o  see  whet  her  or  not  any  VLF  bins  drift  ini;  was  taking  place.  The  results  could  then  be  i  outpaced  with 
the  estimates  of  VLF  bias  arrived  at  by  using  the  Kalman  filter  The  noise  variance  estimates  and  raw 
VLF  diit a  comparisons  are  displayed  in  Table  5.2.  From  this  table  it  ran  be  seen  that  the  VLF  ground 
run  noise  variances  differ  widely  from  one  station  to  the  next,  but  all  are  well  below  the  nominal 
1 .0  ft  sec-  level.  The  VLF  phase  bias  shifts  ( i.e.  p  sect,  based  on  VLF  measurements  taken  about  .a i 
minutes  apart .  are  ali  fairly  small  except  for  the  bus  shift  of  VLF  stilt  mu  If  A  closer  look  at  st  alien 
It's  phase  readings  reveals  that  a  fixed  drift  rate  of  about  1  7.(1  p  see  hour  exists,  apparent  ly  dim  t. , 
inaccuracies  in  the  frequency  of  transmission.  It  was  felt  that  it  would  be  an  ideal  lest  for  the  Kalman 
filter  to  try  to  track  the  known  drifting  VLF  slat mn  This  part  miliar  real  VLF  data  was  considered  to 
lie  quite  represent  at  ive  of  what  to  expect  m  the  way  of  t  ypual  VLF  data  durum  the  course  of  a  flight 
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TABLE  5.3 

VLK  STATION  INFORMATION  FOR  THE  NAVIGATION  STUDY 


Station 

Groundrun  Variance 

Phase  Measurement 
at  T  =  0  See 

Phase  Measurement 
at  T  =  2970  See 

p  See 

L 

0.012  p  sec: 

9850.5  p  see 

9852.5  p  sec 

2.0 

\1 

0.005  p  sec 

3661.4  p  sec 

3660.0  p  see 

1 .  1 

D 

0.103  p  see” 

1138.9  p  sec 

11  10.0  p  see 

1.1 

G 

0.093  p  see' 

2101.1  p  see 

2103,1  p  see 

0.7 

W 

0.01 1  p  sec 

6236.6  p  sec 

6236.9  p  sec 

0.3 

R 

0.01  I  p  sec 

6783.5  p  sec 

6797.6  p  sec 

11.1 

I  ABLE  5.1 


REAL  DATA  INITIAL  CONDITIONS  FOR  THE  NAIVE  KALMAN  FILTER 


Position:  PLAT  '("’LONG 
Bias  in  Doppler  Groundspecd :  Bv 
Bias  in  triii' track :  B 

Biases  in  VLK  phase  measurements:  B  ( i  1 . til 

Noise  variance  for  V|  ( ( ( (, :  n-  ^ 

Noise  variances  for  o-p:  <>'  u 
Noise  variances  for  V LF  stations:  e 
Error  covariance  matrix.  P 

Variances  of  PLAT  I’i.ONG  :  P  (l.lip  (2.2l 
Variance  of  Bx  :  P  (.1.  3| 

Variance  of  B  P  I  1 .  1 1 

Variances  of  B  P  •  P  (lo.Kli 


15.3158  75.0053  dep 
0.0  knot 
0.0  dep 
0.0  p  sec;  all  i 
1  .0  knot " 

2.5. .2.5  delt¬ 
as  per  Table  5.0 

o  (iiiiji  ii  until  <|en 
loo  II  km  a 
loo  o  ,  I,  u 

O  I  I  1  J)  Sl'l  .  .ill  i 


-  M  - 


Table  5.1  indicates  the  initial  condition  specifications  for  a  naive  version  of  the  Kalman 
filter  that  was  run  using  the  real  navigation  data.  Specification  of  VLF  noise  variances  based  upon 
groundnut  measurements  was  felt  to  be  quite  valid,  even  for  the  naive  Kalman  filter,  since  these 
measurements  can  be  accomplished  quite  simply  before  the  start  of  any  navigation  flight.  Moreover. 

noise  variances  for  a,  (j  namely  u~  .  o~  -  were  specified  as  2.5  deg”  each,  based  on  examining  the 
raw  Doppler 'heading  data  attain,  something  that  would  normally  be  available.  The  variances  on 
and  B  were  set  quite  high  in  order  to  estimate  any  Doppler /heading  biases  very  quickly. 

1  towever,  the  variances  on  all  the  B  's  were  set  fairly  low  to  avoid  a  strong  interaction  annum  V  I.F 
bias  estimates  because  of  the  linear  dependencies  known  to  exist.  Figure  52  shows  the  Kalman  filter 
outputs  based  on  the  specifications  defined  in  Table  5.1.  In  Figure  .'Id.  the  associated  position  errors 
are  displayed,  based  on  the  13  visual  fixes  available  during  the  course  of  the  flight.  It  can  be  seen  from 
these  position  error  plots  that  the  overall  error  is  fairly  small  for  over  half  the  flight  and  then  it  starts 
to  increase.  The  increasing  error  is  felt  to  be  due  to  the  effect  of  VLF  station  K's  drifting  eventually, 
the  phase  drifting  begins  to  effect  the  Kalman  filter  accuracy.  Judging  from  the  VLF  phase  bias 
estimates  in  Figure  32,  the  filter  is  attempting  to  follow  the  drifting  in  station  R  but  just  cannot  keep 
up.  The  information  from  Table  5.3  suggests  that  estimation  of  the  VLF  biases  m  I.  and  M  i-  at  least 
proceeding  in  the  right  direction.  I  lowcver.  the  other  VLF  bias  estimates  appear  to  be  incorrect  m  > 
doubt  the  linear  dependency  problem  is  manifesting  itself.  In  sharp  contrast.  Figure  32  'hows  that  tie 
Doppler  heading  bias  estimates  are  resolved  rather  quickly  and  then  remain  at  reasonably  run-tan: 
values. 


In  order  to  alleviate  the  detrimental  effect  of  VLF  station  R  drifting,  a  -mart  Kalman  Lit.  • 
was  designed  specifically  to  track  station  R’s  shifting  bias.  As  well,  this  version  of  the  Kalin. m  lilt'  i 
concentrated  on  estimating  the  two  largest  VLF  biases  (as  determined  from  l  able  5.5i.  pane  1\  .  ::  . ». 
of  VLF  stations  L  and  M.  1'he  changes  that  were  made  to  the  initial  conditions  m  order  to  defim 
smart  Kalman  filter  are  outlined  in  Table  5.5.  Note  that  the  error  covariance  diagonal  .  leim  in- 
corresponding  to  \'LF  l>ias  estimates  in  stations  D.  fl.  and  U’ li.e.  B  (7.7 1  -I’  td.dM.ir-  -ei  to 

/ero,  which  means  that  VLF  bias  estimation  is  not  even  being  attempted  for  these  particular  -tat  an  - 
Figure  3  I  displays  the  vai  ions  smart  Kalman  filter  estimates  as  a  function  of  t  mir  while  Figure  35 
shows  the  result  mg  position  errors  at  the  1  3  visual  check-points.  From  Figure  3  I  it  can  be  seen  si,.,: 
the  smart  version  of  the  Kalman  filter  is  tracking  the  drift  m  station  R's  bias  quite  aecurateh  i  re.  ail 
that  the  drift  rate  is  about  1  7  gi  sec  hour).  Moreover,  bias  estimation  for  V  LF  slat  ion-  I.  and  M 
appears  to  be  proceeding  m  the  right  direct  .on.  The  results  in  Figure  35  indicate  t  hat  the  po-:t  i.m  .  n .  u 
increases  somewhat  during  the  initial,  transient  region  of  Kalman  filtering  action  and  then  appear-  p 
settle  down  quite  nicely .  as  expected  for  proper  operation  of  t lie  Kalman  filter.  Notice  that.  her.  . 
Doppler  heading  bias  estimation  is  almost  identical  to  t  hat  of  the  naive  filter  ease.  The  rat  her  -mali 
Doppler  head  mg  biases  est  i  mated  suggest  that  the  Doppler  heading  dead  reckon  mg  na\  mat  uu  i  n . 

I-  reasonably  accurate  for  this  particular  flight  data. 


I  ABI.K  5.5 

(  IIANC.I  S  TO  INITIAL  CONDITIONS  FOR  TIIF  SMART  KALMAN  I  II  I  I  R 


Km  >r  covariance  mat  nx  .  I’ 

Variances  of  R  V 

I’  (5.  5  i  I’  id.  d  l  1 1  in. n  10(1."  /i  sc. 

I’  (7.7)  -  I*  Id.  in  "  "  p  see 

1"0  "  1 1  set  .  lived  h  il 
dural  urn  of  fl  iglil 


I'  (ID.  I  O  I 


A  comparison  study  was  conducted,  tor  the  same  set  of  real  navigation  data,  mvolv  mg  the 
various  possible  navigation  algorithms  ( i.e.  Doppler  alone,  VTF  alone,  and  Doppler  V  1. 1-'  complemen¬ 
tary  liltcr  as  well  as  the  different  versions  of  the  Kalman  filter).  The  results  of  this  study  are 
summarized  in  the  comparison  plots  shown  m  Figure  .!(>.  Navigation  Using  Doppler  alone  is  surpris¬ 
ingly  accurate,  with  the  total  position  error  rising  to  a  little  over  d.O  nm  alter  one  hour.  Most  hkelv. 
the  position  errors  would  have  been  higher  for  Doppler  only  navigation  if  a  straight-line  alter. ui 
trajectory  had  been  used  instead  of  the  racetrack  patterns  that  were  flown  recall  from  the  Simula 
turn  studies  how  the  Doppler  heading  errors  tended  to  lie  bounded  for  the  circular  track  case.  The 
second  plot  m  Figure  .'i(i  shows  Doppler  VLK  complementary  filter  position  error  results  VI. I-'  alon 
is  not  shown  because  the  results  are  virtually  identical  to  those  id  the  complementary  filter.  The  total 
posit  ion  error  ol  the  ct  implement  ary  filler  rises  to  til  most  d.O  nm  after  one  hour  due.  no  doubt ,  to 
the  various  \  1. 1*  biases  and.  ol  course,  the  constant  drill  rate  of  VI. F  station  |{.  The  naiu-  Kalman 
t liter  and  smart  Kalman  filter  I  i.e.  SMART  K FI  )  results  refer  to  the  versions  of  the  Kalman  filter 
described  earlier  in  this  section.  From  Figure  .'!(>  it  can  be  seen  that  the  Kalman  filter  approach 
certainly  improves  the  overall  positional  error  very  significantly. 

The  results  of  one  other  Kalman  filter  run  are  displayed  as  the  bottom  trace  m  Figure  .'hi 
1 1  e.  SM  All  1  K  K2 1.  Kxpernnont atton  revealed  this  to  be  'he  most  accurate  result  at  tamable:  and  the 
particular  initial  conditions  that  produce  this  result  are  rather  interesting.  For  this  case,  all  error  on- 
v  ur i  nice  diagonals  reiat  mg  ti  >  V  LF  bias  est  jtnal  ion  were  set  to  zero  i.e.  no  V  I.F  inn-  e-t  mint  ton  was 
taking  place'  All  other  initial  conditions  on  the  filter  were  the  same  as  for  tin-  \NAIVF  K  I"  and 
SMAK  f  Kl-  T  eases.  Normally,  with  no  VI,F  bias  est  i  mat  ion  taking  place,  anv  significant  bia-  build  u 
m  the  \  Id-  phase  measurement  s  would  afleet  the  accuracy  of  the  filter  outputs.  I  low  ever.  ar.  ord  mg 
to  the  \  |,F  bias  shifts  m  d  lea  1 1  d  m  lable  a . I .  the  const  ant  drift  rate  of  V  1 .  K  station  K  is  tin-  .ml  v  leas 
slid!  ot  any  real  eotisei|Ueiiee.  Furthermore,  the  groundnut  noise  variance  for  K  is  abnnrmaliv 
compared  to  the  other  \  l.F  'tat  ion  noise  variances  i  more  than  two  orders  of  magnitude  compared  • .  • 
that  o  |  stat  ion  Mi.  so  the  Kalman  filter  has  a  strong  tendency  to  'weight  out '  the  m  flu. -in  e  .  d  V I .  F 
station  K  m  the  overall  position  estimate.  On  this  basis,  the  Kalman  filter  position  estimate  can  be 
'iuiie  accurate  w  about  going  to  the  extent  of  VLK  inns  estimation,  As  a  matter  of  fact,  allow  ing  ;h. 
Kalman  tiller  to  estimate  VI. F  biases  probably  introduces  an  additional  constraint  and  complex!’, \ 
which  tends  to  decrease  the  accuracy  of  position  est  i  mat  ion  in  l  li  is  ease  the  known  linear  depen 
demies  among  \  L  (•  bias  estimates  also  come  into  play  here.  Of  course,  the  sit  nation  would  prnb.tbi  v 
be  a  lot  di  1 1  e  rent  if  very  significant  biases  had  developed  in  one  or  more  of  the  cr  it  leal  V  l.F  'tat  ton- 
i  hen  V  l.F  bias  est  i  mat  ion  would  come  into  its  own,  as  demonstrated  in  the  simulation  results. 

-’>.M  Summary  of  Results 

five  major  results  from  the  comparison  study  are  the  following: 

Dead  reckoning  navigation  using  the  Doppler 'heading  system  is  quite  sensitive  to  biases, 
even  to  fairly  small  ones,  especially  for  the  typical  straight-lme  tracks  that  are  flown.  Any 
Doppler  heading  luas  errors  will  result  m  a  position  error  which  diverges  with  time 

Nav  igatnm  using  an  average  of  all  VI. F  information  is  somewhat  sensitive  to  VI. F  Inns  shifts 
and  ot  her  V I ,  f  anomalies  t  hat  invariably  occur.  Fortunately,  these  errors  usually  result  m 
a  hounded  position  error  as  a  funetii  n  of  time,  except  for  the  drifting  VI, F  station  eondi 
1 1'  hi 

I  lie  Doppler  \  l.F  com  piemen  l  ary  filter  is  completely  immune  to  Doppler  heading  biases 
and  has  a  weak  tendency  to  'smooth  out'  the  VI. F  position  estimates  as  well  as  to  reduce 
the  error  slight  ly  However,  the  complementary  filter  response  is  still  affected  he  V  l.F  hia-.e 
and  slat  ion  drifting. 

I  he  Kalman  I  lit  er  has  a  very  -t  rung  s moot  h mg  act  ion  on  I  lie  posit  ion  error  and  it  can  In- 
ext  remely  in  sen  sit  ive  to  hot  It  Doppler  heading  and  \  l.F  biases,  depending  upon  the  initial 
conditions  chosen.  The  smart  version  of  the  Kalman  filter  is  always  found  to  he  significantly 
superior  to  the  complementary  filter  approach. 
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( )ut [Hit  errors  from  ;i  naive  version  of  the  Kalman  filter  ran  lie  a  lot  larger  than  those  from  a 
smart  version.  The  naive  Kalman  filter  navigator  appears  to  lie  especially  sensitive  to  initial 
condition  specifications  regarding  the  quality  of  the  plant  and  the  status  of  the  various  \  Id- 
stations  being  Used. 

l  iie  Kalman  filter  navigator  has  demonstrated  ils  accuracy  when  applied  to  typical,  real 
na\  igation  data  even  to  the  extent  of  being  aide  to  track  a  real,  drifting  \  Id-'  station. 

ti.o  roNt’i  i  sions 

•id  Assessment  of  the  Kalman  Filter  Approach  to  Navigation 

The  Doppler  V LF  Kalman  filter  studied  in  this  report  has  shown  the  many  advantages  of 
this  type  of  approach  to  the  navigation  task,  l'robahly  one  of  the  main  advantages  the  Kalman  filter 
approach  ot  lei's  is  llcxihilit y  in  lerms  ut  handling  redundant  navigat  ion  m format  ion  in  some  optimal 
! asiuon ,  \  ariotis  navigation  t ransdueers  can  he  modelled  into  the  Kalman  filter  format  fairly  ivadil v 
and.  hence,  can  he  used  to  their  full  potential.  The  Kalman  filler  is  also  very  flexible  when  it  comes 
to  handling  the  raw  data  from  any  given  nav  igation  i  onfiguraiion  m  particular,  tin-  very  basil  trans¬ 
ducer  relationships  can  he  modelled,  d  so  desired.  A  priori  knowledge  concerning  the  quality  and 
relative  accuracy  ol  the  various  navigation  transducers  can  be  put  to  good  use  bv  the  Kalman  filter 
w  it  ness,  especially,  the  results  obtained  when  attempting  to  track  Y  I.F  biases  and  bias  drift  s.  The 
1  loppler  \  I.F  Kalman  filter  has  eerlamlv  demonstrated  live  benefits  to  be  gamed  from  modelling  and 
est limiting  dil lei'eni  bias  error  quantities,  and  it  has  aNn  .shown  just  how  simple  the  modelling  e.-inia- 
t a  mi  process  can  become.  A  bonus  to  be  gamed  from  estimating  Doppler  heading  biases  Using  tin 
Kalman  filler  is  the  fact  that  improved  estimates  of  the  aircraft  vvloei'v  -  omponent'  car:  then  m- 
compuied.  Tin-  concept  of  estimating  the  various  error  quantities  of  lie  -  overall  me.  igai  am  system  m 
reai  time  implies  that,  should  or  a  |  an  o  t  die  system  tail  at  some  poii  1 1  in  time,  nav  igai  to  1  n  1  ura.  v 
wiii  not  he  severelv  Jeopard  iSei ; . 
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simulation  work  or  experiments  involving  real  VLFdata.  Asian  he  seen  from  the  results 
presented  in  this  report,  proper  handling  of  the  raw  VLF  data,  especially  during  the  various 
"anomalous'  situations  that  can  arise,  is  critical  to  the  successful  operation  of  the  Doppler 
\  l.F  Kalman  filter.  Much  has  been  learned  about  VLF  phase  bias  estimation,  the  associated 
linear  dependencies  which  can  occur,  and  the  possibility  of  bias  drift  estimation.  Neverthe¬ 
less.  a  great  deal  more  work  can  and  should  be  done  in  this  area. 

ii)  Real  lime  Programming  Problems  A  definite  challenge  will  be  the  design  and  implemen¬ 
t'd  inn  ot  a  real  time  version  ot  the  Doppler,  VLF  Kalman  filter  for  use  onboard  the  Coiivair 
research  aircraft .  Although  the  Kalman  filler  simulation  routine  does  a  good  job  of  pro 
cessing  the  real  data  acquired  from  the  Convair  navigation  transducers,  this  is  a  far  erv  Imm 
simulating  a  r.  al  time  operation  onboard  the  aircraft.  The  major  problem  will  be  conversion 
of  the  Kalman  filter  simulation  routines  (written  in  FORTRAN  IV  and  operating,  at 
present,  m  the  IBM  M0M2  l'SS  environment  I  to  the  Interdata  7  M2  minicomputer  onboard 
the  Convair.  At  the  heart  ol  the  problem  will  be  the  computational  speed  and  accuracy 
required  to  propagate  the  Kalman  tiller  matrix  recursion  equations  One  means  of  reducing 
the  computational  burden  might  be  to  lengthen  the  update  interval  from  ten  second'  to. 
say.  twenty  or  thirty  seconds.  Simulation  studies  could  be  done  to  determine  the  .■fleet  a 
longer  update  interval  might  have  on  basic  estimation  accuracy.  The  costs,  of  simulation 
runs  in  the  I  SS  environment  are  expensive  lor  the  ten  second  updat e  case  as  it  stands  in > v, 
l‘ °r  example,  it  cost s  about  Sod.  and  takes  1  ()()  seconds  of  ( 'PI  ’  t line  for  one  Kalman  t i 1 1 . - r 
run  using  the  hour's  worth  of  real  navigation  data. 

nil  Navigation  System  Augmentation  Kventually.  other  navigation  transducers  available  to 
the  Convair  will  be  included  in  an  augmented  version  of  the  navigation  filler  described  m 
this  report.  The  next  navigation  aid  to  be  included  will  probable  be  the  Litton  1.1  N'-bl 
inertial  navigation  system  two  dil  leivnt  approaches  could  be  used  to  integrate  the  1.1  N  A ! 
information  into  an  expanded  model.  The  simpler  approach  would  involve  treating  til. 
inertial  nav  igator  as  a  "black  box"  and  using  its  position  and  velocity  outputs  as  additional 
measurements  the  Kalman  filter  plant  would  slay  the  same  as  before  n.e.  tin  Doppler' 
heading  update  equations).  A  more  complex  approach  to  the  problem  would  have  the 
inertial  system  as  the  basa  plant  model:  Doppler,  heading,  and  VLF  would  then  in-  ivb..u 
dan t  measurement  quantities.  1  lie  approach  would  imply  having  access  to  tin-  hasp  .nor: i.u 
quantities  ol  die  L  I  N  -  u  1  sy  si  cm  1 1  .e .  linear  accelera  t  lops  and  align  lar  ra!  es  o  1  .  |  lar.g.  i .  A 
simulation  study  comparing  the  two  approa.  lies  would  help  to  determine  which  is  tin  nion 
effective  direction  to  take  m  Using  the  Litton  data. 
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FIG.  3:  BLOCK  DIAGRAM  OF  KALMAN  NAVIGATION  FILTER  SIMULATOR 
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FIG  4  F  LOWCHART  OF  KALMAN  f  IL  U  R  SIMUL  A  FOR 


FIG  5  KALMAN  FILTER  OUTPUT  ERRORS  FOR  SMALL  INITIAL  ERROR  VARIANCES 


FIG.  7.  KALMAN  FILTER  OUTPUT  ERRORS  FOR  LARGE  INITIAL  ERROR  VARIANCES 
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FIG.  8:  STABILIZATION  OF  P  AND  K  MATRICES  WITH  TIME  FOR  SMALL  P, 
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FIG.  9:  STABILIZATION  OF  P  AND  K  MATRICES  WITH  TIME  FOR  MEDIUM  P„ 
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FIG.  10:  STABILIZATION  OF  P  AND  K  MATRICES  WITH  TIME  FOR  LARGE  P_ 


-  61  - 


m 


V 

•xtn 


> : 


ft-; 
c 1 

ft 
fK 
t,  i 

CO 

c  5 

.  i 

E  "< 

ci : 

.  i 


.1 


<  >  l  3 

r  h 


*8 


*9 


<*>  t  5 


a: 

O 

a. 

rr 


*  ^ 
<;  *  - 

9?!  ™ 


fa 


s* 

o 

8 

* 

6 

4 


i  • 

:  ~) 
c ) 

i  • 

t ; 


n: 

uj 
.  j 

n. 

Cl. 

o 

o 


HCMf 


?Non 


hohm:i 


fra  cA® 


SIN  J  ,)0.!A 


FIG.  11:  KALMAN  FILTER  OUTPUT  ERRORS  FOR  LARGE  INITIAL  BIAS  ERROR  VARIANCES 

NO  VLF  BIASES  SIMULATED  IN  DATA 


FIG.  12:  KALMAN  FILTER  OUTPUT  ERRORS  FOR  LARGE  INITIAL  BIAS  ERROR  VARIANCES 
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FIG.  13.  STABILIZATION  OF  P  AND  K  MATRICES  WITH  TIME  FOR  LARGE  P, 
AND  DAVIS  STRAIT  LOCATION 
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FIG  16  KALMAN  FILTER  RUN  WITH  FOUR  OUT  OF  SIX  VLF  BIASES 
BEING  ESTIMATED  FROM  POOR  INITIAL  CONDITIONS 
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KALMAN  FILTER  OUTPUT  ERRORS  -  TWO  DRIFTING  VLF  STATIONS 
WITH  APPROPRIATE  Pn  ELEMENTS  FIXED 
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FIG  22  COMPARISON  OF  TOTAL  POSITION  ERRORS  USING  DATA 
WITH  LARGE  DOPPLER  BIASES 
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FIG.  24:  DOPPLER  BIAS  ERROR  PLOTS 
LARGE  DOPFLER/HEADING  BIASES  SIMULATED 
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FIG.  25:  COMPARISON  OF  TOTAL  POSITION  ERRORS  USING  DATA 
WITH  LARGE  VLF  BIASES 


NAIVE  KALMAN  FILTER  OUTPUT  ERRORS  FOR  LARGE  DOPPLER/HEADING  BIASES  AND  LARGE  VLF  BIASES 
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FIG.  27  SMART  KALMAN  FILTER  OUTPUT  ERRORS  FOR  LARGE  DOPPLER/HEADING  BIASES  AND  LARGE  VLF  BIASES 
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FIG  28:  COMPARISON  OF  TOTAL  POSITION  ERRORS  USING  DATA 
WITH  A  LARGF  VI  F  DRIFT 
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FIG  3b  POSITION  ERRORS  FOR  SMART  KALMAN  FILTER  RUN 
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APPENDIX  A 

ALGORITHM  FOR  HANDLING  DOPPLER  BEAM  FREQUENCY  DATA 


The  raw  Doppler  data  consists  of  three  IIP'  beam  frequencies  each  sampled  at  a  twice  per 
second  rate.  The  beam  frequencies  —  f  ,  fh ,  f  —  are  defined  as  follows: 

f  :  starboard  forward-looking  beam  frequency; 
fb  :  port  forward-looking  beam  frequency; 
fL  :  port  backward-looking  beam  frequency. 

The  components  of  velocity  in  each  of  the  three  body-fixed  aircraft  axis  directions  (i.e.  u:  forward; 
v:  starboard;  w:  vertical)  can  then  be  expressed  as 

u  =  [<f()  +  50000)  -  <f  +  50000)]  /8.925;  (knots) 

v  =  H  f (  +  50000)  (fh  +  50000)]  /-1.4625;  (knmsi  <  A 1 ) 

w  =  [(fa+f  )  -  50000 J  /20.576;  (knots) 


To  convert  the  velocities  u.  v,  and  w  into  a  straight -and-level  co-ordinate  system  (x.  y. 
x  positive  forward,  y  -  positive  to  starboard,  z  -  positive  local  vertically  upward)  one  must  use  the 
pitch  (())  and  roll  (0)  aircraft  attitude  information.  Assuming  0  is  positive  for  i.ose-up  attitude  and  0 
is  positive  for  right-wing-down  attitude,  the  three  straight-and-level  components  of  Doppler  velocity 
becon 


=  cos  0  •  u  +  sin  0  •  sin  0  •  v  +  sin  ()  •  cos  0  •  u 

V  =  cos  0  •  v  -  sin  0  •  w  i.\2l 

V  “  sin  0  •  u  -  cos  0  •  sin  0  •  v  -  cos  0  ■  cos  0  •  w 


The  groundspeed  ( V|  ()  p  )  and  drift  angle  («)  quantities,  more  useful  m  the  Doppler  navica 
tion  model,  are  then  expressed  as 


V 


hoi* 


( knotsl 


i  Ad 


I 


o  arctan  (  .'V  ^  );  l  radians) 
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APPENDIX  B 


VLF  COMMUNICATIONS  STATION  INFORMATION 


Letter 

Designation 

Call  Sign 

Location 

Frequency 

(KHz) 

Radiated  Power  (kw) 
Nominal  Authorized 

M 

NAA 

CUTLER,  MAINE 

17.80 

890 

1000 

W 

NLK 

JIM  CREEK,  WASH. 

18.60 

250 

1000 

L 

NPM 

HAWAII 

23.40 

140  -630 

1000 

S 

NWC 

NORTH  WEST  CAPE, 
AUSTRALIA 

22.30 

1260 

1000 

R 

GQD 

VNTHORNE.G.BR. 

19.00 

- 

— 

G 

GBR 

RUGBY,  G.BR. 

16.00 

250 

300 

J 

NDT 

YOSAMI,  JAPAN 

17.40 

125 

500 

O 

JXN 

HELGELAND,  NORWAY 

16.40 

150 

350 

A 

NSS 

ANNAPOLIS,  MARYLAND 

21.40 

500+ 

1000 

D* 

— 

LAMORE,  N.D. 

13.10 

9-10 

10 

D  is  actually  an  OMEGA  station  whose  side  frequency  is  being  used  in  a  VLF  mode  of  operation. 


APPENDIX  C 


DEVELOPMENT  OF  PLANT  NOISE  EQUATIONS 


It  is  assumed  that  the  zero  mean,  random  noise  processes  uv , uo ,  and  occur  in  the  meas¬ 
urement  of  V,)0p,  a,  and  (5  respectively  —  the  noise  processes  are  also  assumed  to  have  constant 
variances  oy  ~ ,  ou* ,  and  *  respectively.  The  measured  quantities  (V|)(J  p,  a,  j3)  can  then  be  written 
as  follows: 


Vl)OP  Vlr  +  BV  +  UV 


a  =  a.,.  +  B  +  u 

I  r  a  a 


(Cl) 


0  =  ^Tr  +  +  ^ 


where  each  measurement  consists  of  the  true  value  +  bias  +  random  noise.  It  is  then  necessary  to 
express  PLAT(t)  and  PLONG(t)  as  functions  of  the  noise  processes  to  see  how  these  noise  processes 
are  propagated  through  the  basic  Doppler  differential  equations.  The  continuous-time  Doppler  equa¬ 
tions  can  be  written  as 


PLAT(t) 


(Vn o p  -  Bv  ~  uv)  •  cos(n  +  g-  Ba  -  B,- u,  -  u.) 
60 


PLONG(t) 


~(Vi)OP  ~  Bv  ~  uv)  *  «n(a  +  p-  Ba  -  B^  -  uq  -  uj 
60  ’  cos  (PLAT  •  7t/180) 


(C2) 


For  simplification, define  V  =  V..,..,  -  B. , ,  B  =  B  +  B,,u  „  =  u  +  u.,o  =  a  2 

r  9  o  l)l)r  V  ’  afi  a  ’  a  a  (S*  a 

+  o02,(a  +  l 3)u  =  a  +  (3  -  Ba(J.  Then  Equation  (C2)  becomes 


PLAT(t) 


(v..  -  "v) 


60 


•  cos  [(a  +  0)o  ~  u.J 


(C3) 


-  (Vo  ~  uv)  '  sin[(a  +  0)„  "  U,»J 


PLONG(t)  = 


60  •  cos  (PLAT  •  jt/180) 
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If  Equation  (C3)  is  expanded,  the  result  is 
V, 

PLAT(t)  =  *  [cos  (a  +  j3)o  -cos(uu(J)  +  sin  (o  +  0)o  -sin(u^)J 


[cos  (a  +  /3)o  -cos(u^)  +  sin  (a  +  0)_(  -sin(u 


-  v, 

PLONG(t)  =  -  — 


[sin  (a  +  0)o  •  cos  (ua(J)  -  cos  (a  +  0)(i  •  sin  (u^)] 
60  •  cos  (PLAT  •  jt/180) 


(Cl) 


uv  •  [sin  (a  +  0)o  -cosfu^)  -  cos  (a  +  p)u  -sinfu^)] 
60  •  cos  (PLAT  •  jt/180) 


The  small  angle  approximation  applied  to  uy  and  uy  implies  that 

1  r 

PLAT(t)  =  —  •  [V()  •  cos  (a  +  /3)t>  +  uu  J  •  V  (  •  sin  (a  +  (3)o  -  uv  •  cos  (a  +  (3) 


-  uv  •  uay  •  sin  (a +  /))„] 


<C  5) 


PLONG(t)  = 


V„  ’  sin  (a  +  (3)o  +  uq(J  •  V  t  •  cos  (a  +  0)o  +  uv  •  sin  (a  +  0)o 
60  •  cos  (PLAT  •  jt/180) 


-  uv  ’  Uqtf  •  cos  (a +  01 
60  •  cos  (PLAT  •  jt/180) 


In  Equation  (C5),  the  noise  cross  term,  uv  •  u  ,  can  be  eliminated  because  uv  and  u  are  assumed 
to  be  uncorrelated,  implying  that  uv  •  u  will  have  only  a  seond  order  effect  at  most.  With  this 
approximation,  the  equivalent  noise  processes  in  PLAT  and  PLONG,  u,  A  (  and  u(  ()N(.  respectively, 
can  be  expressed  as 
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I.  A  1 


~  U, 


60 


a  IS 


•  cos  (a  +  8)  +  - —  •  V  •  sin  (a  +  B) 

'  n  'O  0Q  O  ' 


l()  N  ( '• 


[uv  •  sin  (a  +  +  uq(J  *  Vo  •  cos  (a  +  0)J 

60  •  cos  (PLAT  •  w/180) 


(C6) 


and  the  corresponding  variances  of  these  noise  processes  would  be 


I  A  T 


O.,  ~  0  . 

V  -i  .  a(J 


A  QP  -1 

—  •  COS- (a  +  (3)o  + - ‘  v»“  ■  sin"  (a  *■  p)ti 

(60)2  (60 )~ 


1  ()  N  (I 


[av2  •  sin2(a  +  (3)o  +  Oa>j2  •  Vi(2  •  cos2  (a  +  0)o] 
[60  •  cos  (PLAT  ■  jt/180)]  2 


(C7) 


The  equivalent  noise  processes  for  the  continuous-time  Doppler  system  of  Equation  (C2) 
have  just  been  defined.  However,  in  order  to  calculate  the  G  k  needed  in  the  Kalman  filter  implemen¬ 
tation,  it  is  necessary  to  look  at  the  sampled-data  version  of  the  Doppler  state  equations.  Including 
noise  processes,  these  equations  can  be  written  as  follows: 


PLATkH  PLATk  +  (Alk  A3k  "®Vk^  ’  S*n  ^  +  ^A^k  A4k  ‘  ’  l'OS*B^k* 


+  60 


2  ’  k  *  10 

f  uft(J  ’  <vim>p  -  Bvk>  •  sin(«J  B~  BU(ik>dt 


1 

60 


'k  *  111 


/  Uv  *  cos  («  +  0  B  ^ik  )dt 


((’8) 


PL()NGkt|  =  PLONGk 


[(Alk  A3k^BVk)-cos(Ba  tk)  +  (Alk  •  Bv  k  A2k )  •  sin(B k )] 
cos  (PLATk  •  it/180) 


•k  *  1,1 


I  u,.,i  '  (Vh(),  BVk)  ■  cos  to +0-  B(k)dt  +  I  uv  •  sin  (ti  t  p  B  k  )dt 


L  'k 


60  •  cos(PLATk  •  it/ 180) 


where 
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A1k  =  ~  •  /  VDOp  -sin(a  +  /3)dt 


*k  +  10 


A2.  s  ~ 


1_ 

60 


«k  +  10 


/  Vdop  '  cos(a  +  0)dt 
‘k 


(C9) 


A3,  s 


1 

60 


«k  ♦  io 


/  sin  (a  +  0)dt 


_i 

60 


«k  +  10 


A4.  =  T~  '  /  Cos  (a  +  0)dt 


As  a  simplification,  assume  average  values  for  V()  Q  p ,  a,  and  (3  over  the  integration  interval 
(i.e.  for  the  noise  terms  only)  by  using  their  values  at  t  =  tk  +5.  Furthermore,  define  new  random 
noise  processes,  u*  and  Uy ,  as  follows: 


a  0k 


V  k 


‘k  +  1  0 

f  Uc0dt  = 


*k  +  10 

/  uvdt 


•k  +  10 

/  (uo+U(j)dt 


(CIO) 


With  these  changes,  the  discrete  Doppler  equations  become 


PLAT_,  =  PLATk  +  (Alk  -  A3k  •  BVk)  •  sin(Bo(Jk)  +  (A2R  -  A4k  •  BVk)  •  cos(B„,Ik) 


‘k  +  i 


+  A5k  '  Ua0k  +  A6k  '  UVk 


(Cll) 


PLONGk  +  |  =  PLONGk 


[<A1k  ~  A3k  ‘  BVk>  •  cos(Ba(Jk)  +  (A4k  •  BVk  -  A2k)  •  sin(BQ(jk)] 


cos  (PLATk  *  tt/180) 


+  A7. 


a  0k 


+  A8, 


'Vk 
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where 


A5k  s  — - 
k  60 


'  (vdop  "  Bvt»  *  «n(«  +  0  -  B  ) 


<k  +  5 


A6 


k  =  ^-c°s(a  +  0  -  BoSk) 


•k  +  5 


(C12) 


A7 


k 


(VDOP  '  BVk>  *  CO*(«  +  P  -  Kp k> 
60  •  cos  (PLATk  •  jt/180) 


5 


A8 


k 


sin  (a  +  -  Ba<jk) 

60  •  cos  (PLATk  •  jt/180) 


'k 


+  5 


In  spite  of  the  fact  that  the  continuous  noise  processes,  uq(J  and  uv  ,  are  assumed  to  have 

constant  variances  and  zero  means,  the  corresponding  discrete-time  noise  processes  do  not  necessarily 
have  to  have  these  characteristics,  mainly  because  of  the  coloration  effect  that  the  integration  process 

will  have  on  the  noise.  Nevertheless,  for  the  purposes  of  the  Kalman  filter  implementation,  u*(jk 

and  Uy  k  will  be  assumed  to  have  the  constant  variances  —  o*a2  and  Oy 2  respectively  —  where  o *  (J  2 

and  a*  2  will  be  chosen  to  have  about  the  same  order  of  magnitude  as  oQ(J2  and  ov  2 . 

From  the  foregoing  developments,  the  discrete  plant  noise  process  can  be  identified  as 

“k  =  K  <ok]  (C13) 


having  the  auto-covariance  matrix , 


9k 


(Cl  4) 


f 
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APPENDIX  D 

EVALUATION  OF  3d0i/3PLAT;  3dtf>i/3PLONG 

Recall  that  the  general  observation  equation  for  expressing  VLF  station  phase  difference 
measurements  is 

<t>\  =  d0i(PLATk ,  PLONGk )  +  B0ik  +  v0jk;  i=l . 6  (Dl) 

Now  d0i  represents  the  relationship  between  a  specified  (PLAT,  PLONG)  geographical  position  and 
the  theoretical  phase  difference  of  VLF  station  i  (PLAT,  PLONG  in  units  of  geographical  degrees  and 
d0i  in  units  of  microseconds).  It  is  impossible  to  express  d0i  explicitly;  however,  each  d0i  is  readily 
calculated  from  computer  algorithms  that  can  generate  theoretical  VLF  station  phases  for  any 
specified  geographical  location  via  the  Sodano  inverse  routine  (Refs.  18  and  19). 

The  partial  derivatives,  3d0i/3PLAT  and  3d0i/3PLONG,  can  be  expressed  fairly  explicitly 
using  the  following  argument.  Consider  a  geographical  location,  P,  and  a  VLF  station  location,  S,  as 
shown  in  Figure  37(a),  with  dps,  0ps,  and  az  the  distance,  phase,  and  azimuth  (i.e  heading)  respec¬ 
tively  from  P  to  S.  Consider,  also,  a  small  change  in  latitude  only,  ALAT,  in  going  from  point  P  to  a 
new  point,  P',  a  distance  dLAT  away.  Let  dps,  0P  s,  and  a’z  be  the  corresponding  distance,  phase, 
and  azimuth  from  P'  to  S.  Consider,  now,  the  relationship  between  Ad  =  dp  s  -  dps  and  dLAT. 

Based  on  Figure  37(a),  assume  that  az  *=  a'z,  since  dLAT  and  Ad  are  quite  small  while  dps  and 
dp  s  are  quite  large  distances.  It  then  holds  that 

Ad  as  -  cosaz  *dLAT  (D2) 

The  relationship  between  dps  and  (/>PS  is  simply, 

dps(nm)  =  Vs(nm//i  sec)  •  0PS(M  sec)  (D3) 

where  Vs  is  the  speed  of  propagation  of  the  signal  transmitted  from  VLF  station  S.  The  substitution. 
Ad  =  Vs  *  A $,  into  Equation  (D2)  yields 

Vs  ■  A 0  ^  -  cos  az  *  dLAT  =  -  cos  az  *  60  •  ALAT  (D4) 


or 


A  <t> 

ALAT 


-60 

-  •  cos  a, 

v  '■ 


In  the  limit  as  ALAT  -♦  0,  Equation  (D5)  becomes 


(D5) 


(D6) 


In  similar  fashion,  based  on  the  geometry  depicted  in  Figure  37(b),  consider  a  small  change 
in  longitude  in  going  from  point  P  to  point  P'.  Using  the  same  kind  of  argument  as  before,  an  approx¬ 
imate  expression  for  Ad  can  be  determined  as, 


Ad  *  sin  az  •  dLONG 


(D7) 


Substituting  Ad  =  V$  •  Atp  and  dLONG  =  60  •  ALONG  •  cos(PLAT)  into  Equation  (D7)  yields 


Vs  *  A 0  585  sin  a2  ■  60  •  ALONG  •  cos(PLAT) 


(D8) 


or 


A0 


60 


ALONG 


•  sin  az  •  cos(PLAT) 


(D9 


and,  in  the  limit  as  ALONG  -*•  0,  Equation  (D9)  becomes 


60 

3d 0S  /3PLONG  =  —  *  sin  a7 
vs 


cos(PLAT) 


(D10) 


Note  that  both  of  the  partial  derivatives,  3d$/3PLAT  and  3d0/3PLONG,  are  functions  of 
PLAT  and  PLONG  (since,  in  particular,  az  is  a  function  of  PLAT,  PLONG).  Moreover,  for  any 
specified  geographical  position  (PLAT,  PLONG)  and  any  specified  VLF  station,  the  values  of  sin  a/ 
and  cos  az  come  directly  out  of  the  Sodano  inverse  routine  as  it  is  programmed  at  NAE.  Equations 
(D6)  and  (D10)  are  then  used  to  calculate  the  values  of  the  partial  derivatives  for  the  specified  posi¬ 
tion  and  VLF  station. 
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